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still  required  for  the  more  demanding  needs  in  biomechanics,  robotics  and  vehicle  dynamics.  The  scientific  research  in  multibody  system 
dynamics  is  devoted  to  improvements  in  modeling  considering  nonholonomic  constraints  flexibility,  friction,  contact,  impact  and  control. 
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applied  to  a  broad  variety  of  engineering  problems  from  aerospace  to  civil  engineering,  from  vehicle  design  to  micromechanical  analysis, 
from  robotics  to  biomechanics.  In  particular,  multibody  dynamics  is  considered  as  the  basis  of  mechatronics,  e.g.  controlled  mechanical 
systems.  These  challenging  applications  are  subject  to  fundamental  research  topics  which  were  presented  at  the  NATO  ASI  on  Virtual 
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Scientific  Abstract 


Multibody  system  dynamics  is  based  on  classical  mechanics  and  its  engineering  applications  ranging  from 
mechanisms,  gyroscopes,  satellites  and  robots  to  biomechanics  and  vehicle  engineering.  Multibody  systems 
dynamics  is  characterized  by  algorithms  or  formalisms,  respectively,  ready  for  computer  implementation.  The 
simulation  of  multibody  systems  demands  for  adequate  dynamic  models  and  takes  into  account  various  phe¬ 
nomena.  Classical  dynamics  does  not  regard  all  nonlinear  effects  that  appear  as  a  result  of  the  action  of  multi¬ 
body  systems,  as  well  as  their  mutual  interaction.  The  virtual  prototyping  and  dynamic  modeling  of  such  sys¬ 
tems  are,  from  an  economical  point  of  view,  perspective  fields  of  scientific  investigations  having  in  mind  the 
huge  expenses  for  their  design  and  manufacturing.  Complex  multibody  systems  composed  of  rigid  and  flexible 
bodies  performing  spatial  motion  and  various  complex  tasks  are  up-to-date  objects  of  virtual  prototyping.  As  a 
result  simulation  and  animation  featuring  virtual  reality  are  most  important.  Recent  research  fields  in  multibody 
dynamics  include  standardization  of  data,  coupling  with  CAD  systems,  parameter  identification,  real-time 
animation,  contact  and  impact  problems,  extension  to  electronic  and  mechatronic  systems,  optimal  system 
design,  strength  analysis  and  interaction  with  fluids.  Further,  there  is  a  strong  interest  on  multibody  systems  in 
analytical  and  numerical  mathematics  resulting  in  reduction  methods  for  the  rigorous  treatment  of  simple 
models  and  special  integration  codes  for  Ordinary  Differential  Equation  (ODE)  and  Differential  Algebraic 
Equation  (DAE)  representations  supporting  the  numerical  efficiency.  New  software  engineering  tools  with 
modular  approaches  improve  the  efficiency  still  required  for  the  more  demanding  needs  in  biomechanics, 
robotics  and  vehicle  dynamics.  The  scientific  research  in  multibody  system  dynamics  is  devoted  to  improve¬ 
ments  in  modeling  considering  nonholonomic  constraints  flexibility,  friction,  contact,  impact  and  control.  New 
methods  evolved  with  respect  to  simulation  by  recursive  formalism,  to  closed  kinematic  loops,  reaction  forces 
and  torques,  and  pre-  and  post-processing  by  data  models,  CAD  coupling,  signal  analysis,  animation  and 
strength  evaluation.  Multibody  system  dynamics  is  applied  to  a  broad  variety  of  engineering  problems  from 
aerospace  to  civil  engineering,  from  vehicle  design  to  micromechanical  analysis,  from  robotics  to  biomechanics. 
In  particular,  multibody  dynamics  is  considered  as  the  basis  of  mechatronics,  e.g.  controlled  mechanical  sys¬ 
tems.  These  challenging  applications  are  subject  to  fundamental  research  topics  which  were  presented  at  the 
NATO  ASI  on  Virtual  Nonlinear  Multibody  Systems. 


1.  Datamodels 

Within  the  multibody  system  community  many  computer  codes  have  been  developed,  however,  they  differ 
widely  in  terms  of  model  description,  choice  of  basic  principles  of  mechanics  and  topological  structure  so  that  a 
uniform  description  of  models  does  not  exist.  The  data  exchange  permits  the  alternate  use  of  validated  multi¬ 
body  system  models  with  different  simulation  systems. 

2.  Parameter  identification 

The  parameter  identification  is  an  essential  part  of  multibody  dynamics.  The  equations  of  motion  of  mechanical 
systems  undergoing  large  displacements  are  highly  nonlinear,  however,  they  remain  linear  with  respect  to  the 
system  parameters. 

3.  Optima]  design 

Due  to  development  of  faster  computing  facilities  the  multibody  system  approach  is  changing  from  a  purely 
analyzing  method  to  a  more  synthesizing  tool.  Optimization  methods  are  applied  to  optimize  multibody  systems 
with  respect  to  their  dynamic  behaviour. 

4.  Dynamic  strength  analysis 

The  results  obtained  in  research  on  strength  analysis  of  material  bodies  can  be  applied  and  combined  with  the 
multibody  system  approach. 

5.  Contact  and  impact  problems 

Rigid  and/or  flexible  bodies  moving  in  space  are  subject  to  collisions  what  mechanically  means  impact  and 
contact.  Contact  problems  usually  include  friction  phenomena  which  are  modelled  by  Coulomb's  law. 

6.  Extension  to  control  and  mechatronics 

The  applied  forces  and  torques  acting  on  multibody  systems  may  be  subject  to  control.  Then,  the  multibody 
system  is  considered  as  the  plant  for  which  the  controller  has  to  be  designed.  Today,  mechatronics  is  understood 
as  an  interdisciplinary  approach  to  controlled  mechanical  systems  usually  modelled  as  multibody  systems. 

7.  Nonholonomic  systems 

The  nonholonomic  systems  are  of  engineering  interest  in  vehicle  dynamics  and  mobile  robots. 

8.  Integration  codes 

The  dynamic  equations  of  motion  are  presented  as  ODE  or  DAE.  Efficient  algorithms  for  numerical  integration 
of  these  equations  are  of  major  importance. 


9.  Real  time  simulation  and  animation 

Efficient  and  fast  simulation  is  always  desirable  in  computational  dynamics  but  it  is  really  necessary  for  hard- 
ware-in-the  loop  and  operator-in-the-loop  applications.  There  are  two  approaches  to  achieve  real  time  simula¬ 
tion:  high  speed  hardware  and  efficient  software.  Multibody  system  dynamics  contributes  to  the  efficiency  of 
the  software  by  recursive  and/or  symbolic  formalism  and  fast  integration  codes. 

10.  Challenging  applications 

Multibody  system  dynamics  has  a  broad  variety  of  applications.  In  biomechanics  the  walking  motion  is  an 
important  topic.  However,  there  are  much  more  problem  in  biomechanics  which  can  be  modeled  and  solved  by 
multibody  dynamics.  The  applications  are  ranging  from  vehicle  occupants  to  sport  sciences.  Multibody  dynam¬ 
ics  is  also  a  solid  basis  for  nonlinear  dynamics.  In  particular,  impact  and  friction  induced  vibrations  show 
chaotic  behaviour.  The  control  aspects  in  multibody  dynamics  are  getting  more  and  more  important.  Vehicle, 
aircraft  and  spaceship  dynamics  and  reliability  have  always  been  challenging  applications.  With  respect  to 
transportation  systems  a  challenging  application  of  multibody  dynamics  is  the  structural  and  occupant  crash¬ 
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Abstract 

This  paper  describes  analytics  and  experiments  on  a 
novel  4-wheel  vehicle.  The  vehicle  has  back  wheel  drive 
and  steering  in  addition  to  wheels  that  can  expand  and 
change  radius.  The  motivation  for  this  design  is  to 
attain  added  navigation  capability  by  expanding  the 
wheels  according  to  the  requirements  of  the  terrain. 
In  this  paper,  we  discuss  the  motion  of  the  vehicle  on 
a  flat  floor.  The  steering  angle  is  kept  at  zero  so  that 
the  vehicle  has  a  planar  motion.  The  contact  point  of 
the  wheel  with  the  ground  is  assumed  to  be  directly 
underneath  the  center  of  the  wheel  and  has  no  slip. 

The  rolling  constraints  are  nonholonomic,  i.e.,  are  non- 
integrable.  The  rate  constraints  are  written  in  an 
input-affine  drift-less  control  system.  The  structure 
of  this  drift-less  control  system  allows  to  determine 
the  differentially  flat  outputs  of  the  system.  Motion 
planning  of  the  vehicle  between  two  configurations  is 
achieved  through  planning  of  these  differentially  flat 
outputs.  These  trajectories  are  then  used  to  deter¬ 
mine  a  feedback  controller.  A  dynamic  simulation  is 
performed  using  MATLAB.  The  motions  are  currently 
being  implemented  on  the  physical  hardware  using  a 
dSPACE  control  system. 


1  Introduction 

Conventional  four-wheel  vehicles  are  either  back  wheel 
or  front  wheel  drive.  There  are  numerous  reported 
literature  on  design,  motion  planning,  and  control  of 
such  unmanned  vehicles.  A  mobile  robot  NOMAD  was 
designed  and  built  for  remote  operations  in  Antarctica 
[9].  This  vehicle  features  a  transforming  chassis  that 
can  expand  or  compact  by  driving  two  pairs  of  four- 
bar  linkages  on  each  side  of  the  robot.  The  unique 


Figure  1:  A  photograph  of  the  vehicle  with  expanding 
_ wheels. _ 


feature  of  the  vehicle  in  our  design  is  that  its  wheels 
can  expand  and  change  radius.  The  motivation  for 
this  design  is  to  attain  added  navigation  capability  by 
expanding  the  wheels  according  to  the  requirements  of 
the  terrain.  This  paper  addresses  the  analytics  and 
other  details  of  motion  planning  and  control  of  this 
vehicle. 


2  Description  of  the  Vehicle 

A  photograph  of  the  vehicle  is  shown  in  Fig.  I.  The 
vehicle  is  built  on  a  chassis  constructed  of  half-inch  alu¬ 
minum  plates.  The  rear  wheels  are  driven  by  an  a.c. 
Kollmorgen  servomotor  through  a  gearbox  and  chain 
drive  system.  The  front  wheels  are  steered  by  an  iden¬ 
tical  a.c.  servomotor  connected  to  a  four-bar  mecha- 


1 


Figure  2:  A  photograph  of  the  wheel  of  the  vehicle. 


nism.  In  addition,  the  vehicle  consists  of  four  wheels 
that  can  expand  and  change  radius  as  shown  in  Fig.  2. 
The  design  of  the  wheels  of  the  vehicle  is  based  on 
polyhedral  single  degree-of-freedom  expanding  struc¬ 
tures  using  prismatic  joints  [1],  Kinematically,  each 
wheel  has  a  single  degree-of-freedom  during  expansion 
and  contraction.  In  the  design,  each  of  the  four  cir¬ 
cular  wheels  is  approximated  by  a  polygon  with  ten 
sides  and  ten  radial  spokes.  The  wheels  use  aluminum 
decagons  as  hubs,  with  composite  air  cylinders  acting 
as  telescoping  (or  prismatic)  joints  along  each  edge  and 
each  spoke.  The  spokes  and  edges  are  joined  using  alu¬ 
minum  nodes  cut  along  three  sides  to  match  interior 
angles,  and  rounded  on  the  outsides  to  provide  smooth 
rolling  while  the  node  is  in  contact  with  the  ground. 
Each  vertex  of  the  polygon  lying  on  the  circumference 
has  the  curvature  of  a  circular  wheel.  The  wheels  are 
actuated  using  a  pair  of  d.c.  linear  actuators  which 
replace  two  spokes  and  are  set  opposite  each  other.  A 
single  control  signal  is  sent  to  both  actuators,  and  po¬ 
sition  feedback  is  read  from  a  potentiometer  which  is 
connected  to  one  actuator  on  each  wheel. 


3  Model  of  the  System 

In  this  paper,  we  arc  modeling  the  motion  of  the  vehi¬ 
cle  in  the  plane  as  the  steering  angle  is  kept  constant 
at  zero.  The  kinematic  model  of  the  vehicle  has  two 
wheels  with  different  radii  in  a  plane  connected  by  a 
rod  in  between,  as  shown  in  Fig.  3.  We  describe  the 
configuration  of  the  vehicle  using  the  following  vari¬ 
ables:  (*i,  Vi)  and  (12,  y2)  are  respectively  the  centers 
of  the  rear  and  front  wheels  in  the  inertial  coordinate 
frame,  6y  and  $2  are  respectively  the  clockwise  angular 
rotations  of  the  spoke  1  of  the  rear  and  front  wheels 
with  respect  to  the  x-axis  of  the  inertial  coordinate 


Figure  3:  A  schematic  of  the  vehicle  with  wheels  during 
_ planar  motion. 


frame  which  we  denote  by  l.  Let  n  and  r2  be  respec¬ 
tively  the  radii  of  the  rear  and  front  wheels,  a  repre¬ 
sents  the  clockwise  angular  rotation  of  the  connecting 
rod  with  respect  to  i  of  the  inertial  frame. 

In  the  design,  a  circular  wheel  has  been  approximated 
by  a  polygon  with  ten  sides  and  ten  spokes.  The  ver¬ 
tices  of  the  polygon  have  been  fabricated  to  approxi¬ 
mate  the  curvature  of  a  circle.  As  the  number  of  sides 
of  the  polygon  is  increased,  the  polygon  better  approx¬ 
imates  the  circular  wheel.  In  the  first  model  of  rolling 
kinematics  of  the  wheel,  we  assume  that  it  is  circular 
and  the  contact  point  of  the  wheel  with  the  ground 
is  vertically  underneath  the  center  of  the  wheel.  This 
assumption  will  be  relaxed  in  future  models  of  the  ve¬ 
hicle. 

3.1  Kinematic  Model 

The  position  and  velocity  of  the  center  of  rear  wheel 
in  the  inertial  coordinate  frame  are  given  by 

rO,  =  ®ii  +  r/ij  (1) 

vo,  =iii  +  yj.  (2) 

The  velocity  of  the  point  Py  on  the  wheel  directly  un¬ 
derneath  the  center  and  in  contact  with  the  ground  is 
given  by 

Vp,  =  v0,  +  uji  x  r0,  p,  -  fj.  (3) 

where  r o,p,  is  a  vector  from  Oy  to  Py  and  w,  is  the  an¬ 
gular  velocity  of  the  rear  wheel.  In  this  equation,  -fj 
represents  the  velocity  component  of  Py  due  to  expan¬ 
sion  of  the  rear  wheel.  From  the  kinematic  descrip¬ 
tion,  u>y  =  —Oyk.  On  substituting  these  expressions  in 
Eq.  (3)  and  simplifying,  we  get 

Vp,  =  (±i  -  r^j)!  +  ( yy  -  fjjj.  (4) 

Since  the  rear  wheel  rolls  about  Py  without  slipping, 
vfi  =  0-  This  gives  the  two  rolling  constraints  for  the 
rear  wheels 

il  =n6i  (5) 

y\  =  n  •  (6) 
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Using  a  similar  procedure  for  the  front  wheel,  we  obtain 


*2  =  r202  (7) 

V2  =  r2-  (8) 

From  the  geometry  of  the  vehicle, 

sin(a)  =  (9) 

cos(a)  =  (10) 


where  l  is  the  length  of  the  connecting  rod  between  the 
wheels. 

In  summary,  the  vehicle  is  described  by  nine  coordi¬ 
nates:  «i,  j/i,  ri,  0i,  S2,  2/2,  f2,  02,  and  q.  These 
nine  variables  are  subject  to  four  rate  constraints  given 
by  Eqs.  (5)-(8)  and  two  configuration  constraints  of 
Eqs.  (9)  and  (10). 


3.2  Models  for  Planning 

The  above  equations  can  be  used  to  eliminate  Xi,  x2, 
3/1 ,  and  3/2  and  provide  a  description  of  motion  in  terms 
of  n,  r2,  0i,  02,  o  and  their  derivatives.  On  differenti¬ 
ating  Eq.  (9),  we  get 


n  -r2 
lcos(a ) ' 


(11) 


On  differentiating  Eq.  (10)  and  substituting  Eqs.  (5), 
(7),  and  (11),  we  get 


3.3  Dynamic  Model 

The  Lagrangian  formalism  was  used  to  develop  a  dy¬ 
namic  model  for  the  mechanism.  The  following  as¬ 
sumptions  were  made:  (i)  Each  wheel  consists  of  ten 
point  masses,  located  at  the  intersection  of  a  spoke  and 
the  circumference,  (ii)  the  center  of  mass  of  the  con¬ 
necting  rod  between  the  two  wheels  is  midway  along 
the  length  and  it  has  a  moment  of  inertia. 


The  kinetic  and  potential  energies  for  the  rear  wheel, 
front  wheel,  and  connecting  rod  were  computed.  From 
the  expressions  of  the  kinetic  and  potential  energy, 
the  Lagrangian  C(q,q)  was  developed,  where  q  = 
[ri  r2  0 1  02, o:]7’.  The  dynamic  model  development 
was  done  in  two  stages.  First,  it  was  assumed  that  the 
vector  q  does  not  have  any  constraints  on  its  elements 
and  the  following  expressions  were  evaluated 


±d£_d£ 

dtdqi  dqi  ’  t-1>-5 


(15) 


These  expressions  are  then  collected  to  form  the  fol¬ 
lowing  structured  forms 


A(q)q  +  b(q,  q)  (16) 


where  A(q)  is  a  (5  x  5)  matrix,  b(q,q)  is  a  (5  x  1) 
vector.  A  vector  of  inputs  F  is  formed  where  F  — 
(Fi,  F2,  M i,0, 0)t.  Here,  F\  is  the  radial  force  applied 
by  the  motors  on  the  rear  wheel,  F2  is  the  radial  force 
applied  by  the  motors  on  the  front  wheel,  and  M\  is 
the  driving  moment  applied  by  the  actuator  on  the  rear 
wheel. 


e  _  tan(a)  .  ,  tan{a)  .  ,  rx  h 

“ 2 - rl  4 - r2  +  - — 0\. 

r2  r2  r2 


Eq.  (12)  is  a  non-integrable  rate  constraint  equation 
while  Eq.  (11)  is  an  integrable  rate  constraint  equa¬ 
tion.  From  the  planning  point  of  view,  we  can  use 
one  of  the  two  alternate  models:  Model  (A)  Eq.  (12) 
-  a  non-holonomic  equation  and  Eq.  (9)  -  a  holonomic 
equation;  Model  (B)  Eq.  (12)  -  a  non-holonomic  equa¬ 
tion  and  Eq.  (11)  -  an  integrable  rate  equation. 


3.2.1  Model  (A): 


where  sin( a)  =  n-;— ^ . 


3.2.2  Model  (B): 


1 

0 

0 


—  ton  (a) 


0  0 

1  0 

0  1 

tan(oi) 

lccs(ct)  ^ 


(14) 


In  the  second  step,  Eq.  (14)  is  first  written  in  the  form 

9  =  Cqg  (17) 

From  [2],  the  equations  of  motion  in  the  presence  of 
the  constraints  are  given  by 

C{q)T{A{q)q  +  b(q,  ?)]  =  C(q)TF  (18) 

J 

On  using  the  relation  q  =  C(q)qg  +  C{q)q9 ,  the  above 
equation  can  be  simplified  to 

C(qfA(q)C(q)qg  +  C(q)T(A(q)C(q)qg  +  b(q,q)) 
=  C(q)TF.  (19) 

This  equation  represents  the  forward  dynamic  model 
of  the  system.  Given  the  trajectory  qg{t),  the  required 
actuator  forces/moments  can  be  computed. 

Similary,  given  the  trajectory  of  actuator 
forces/moments,  the  trajectory  of  the  vehicle  can 
be  computed  as  follows: 

qg  -  [C(9)tA(<7)C(9)]-1[C(9)tF 

-C(qf(A(q)C(q)qg+b(q,q))]  (20) 

This  equation  represents  the  inverse  dynamic  model  of 
the  system.  Given  the  trajectory  F(t),  the  trajectory 
of  the  vehicle  can  be  computed.  The  differential  al¬ 
gebraic  equations  (20)  and  (17)  in  the  variables  q  and 
qg  constitute  the  dynamic  equations  of  motion  of  the 
system. 
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4  Motion  Planning 


On  differentiating  Eq.  (26),  we  get 


For  motion  planning,  we  use  Model  (A)  developed  in 
Section  3.2  given  in  Eq.  (13).  This  model  of  the  system 
is  driftless  and  has  control  in  an  affine  form.  In  classical 
literature,  a  driftless  control  system  has  the  form 

9  =  ff(?K  (21) 

where  q€  If1  are  referred  to  as  the  states,  u6  Ft™  are 
the  controls,  and  g{q)  are  smooth  vector  fields  in  ft". 
In  our  model,  the  three  rates  u  =  qg  =  (ri,f2,0,)T  are 
the  inputs  to  the  system  and  the  state  space  consists 
of  q  =  (ri, r2i ^i>^2)r-  The  variable  a  is  an  internal 
variable  of  the  system  given  by  sin(a)  =  T.izri 

4.1  Differential  Flatness 

Classes  of  dynamic  systems,  referred  to  as  differentially 
fiat  systems,  have  the  special  property  that  Eq.  (21) 
admits  the  following  diffeomorphic  representation  over 
the  state  space  [3]: 

9  =  <?(z,2(1),...,2(p-1)),  (22) 

u  =  u(z,z(1),...,z(p)),  (23) 

where  z  6  Rm  are  suitably  chosen  output  functions 
which  are  determined  using  results  from  linear  and 
nonlinear  systems  theory.  In  the  above  equation,  p  —  1 
and  p  represent  the  highest  derivatives  of  z  in  the  ex¬ 
pression  for  q  and  u,  respectively.  The  integer  p  is  a 
property  of  the  system  Among  others,  flat  systems 
include  controllable  linear  systems  as  well  as  nonlinear 
systems  linearizable  by  static  and  dynamic  feedback. 

For  differentially  flat  systems,  a  trajectory  in  the  space 
of  outputs  z{t)  and  its  derivatives  is  consistent  with  the 
dynamics  if  it  satisfies  the  boundary  conditions.  The 
states  q(t)  and  inputs  u{t)  can  be  computed  from  z(t) 
according  to  Eqs.  (22)  and  (23).  Differentially  flat  sys¬ 
tems  have  been  studied  in  the  context  of  trajectory 
generation  ([3],  (4]),  optimal  control  ([5],  [7]),  and  aux¬ 
iliary  constraints  [6]. 

4.2  Driftless  Systems 

Some  important  results  on  linearization  of  driftless  sys¬ 
tems  through  static  and  dynamic  feedback  are  summa¬ 
rized  in  [8],  Systems  that  exhibit  these  linearization 
properties  fall  in  the  class  of  differentially  flat  systems. 

Since  there  are  three  inputs,  we  need  to  find  three  flat 
outputs  z  =  (z, ,  z2,  z3),  such  that  all  the  system  vari¬ 
ables  can  be  written  as  functions  of  z  and  their  deriv¬ 
atives.  The  system  is  not  static  feedback  linearizable 
since  it  is  driftless.  However,  we  can  choose  the  follow¬ 
ing  set  of  flat  coordinates  by  inspection 


Zi  =  r, 

(24) 

*2  =  r2 

(25) 

Z3  =  —0,  —  02 

r2 

(26) 

is  =  (— Or  -  02 )  +  —0i  -  ^0i  (27) 

r2  r2  *2 

Using  Eq.  (12),  it  can  be  simplified  to 

tan(a)  .  tan(a) .  ,fi  rif2,„ 

23  =  ~  ~r~Lr2  +  -  -2rW  28 

r2  r2  r2  r2 

Now,  0i  can  be  solved  using  the  above  equation 

•  tan  (a)  ^  lan(a)  ■ 

z 3 - H - ^-iV2 

- - l.afa 

where  tan(a)  =  Hence,  0j  can  be  writ- 

V1  — (ri -nzr 

ten  in  terms  of  the  flat  outputs  and  their  derivatives 


i3  + 

(30) 

From  Eqs-  (24H26).  we 

02  =  —01  —  23 
*2 

(31) 

n  =  21 

(32) 

11 

(33) 

On  differentiating  these  expressions,  the  inputs  0,,  f,, 
r2  can  also  be  expressed  in  terms  of  the  fiat  outputs 
and  their  derivatives. 


4.3  Trajectory  Generation 

The  trajectory  planning  problem  can  be  posed  as  find¬ 
ing  a  smooth  trajectory  of  the  variables  0i(<),  02(t), 
nW,  r2(t)  between  two  given  end-points  over  a  time 
to  to  tf.  The  conditions  of  0i(to),  02(lo),  r,  (to),  r2(t0) 
can  be  used  in  Eqs.  (24)-(26)  to  compute  zi(t0),  z2(t0), 
and  z3(t0).  Similarly,  the  conditions  of  0i(f/),  02 (tf), 
ri(tf),  r2(t/)  can  be  used  in  Eqs.  (24)-(26)  to  compute 
*i(*/)>  z?(t/),  and  z3(tf). 

These  boundary  conditions  can  be  used  to  select  a 
smooth  trajectory  for  z(t)  between  to  and  tf.  Now, 
Eqs.  (30)-(33)  can  be  used  to  compute  0i(f),  02(t), 
ri  ( t ),  ri(t)  consistent  with  the  dynamic  equations  (13). 
Note  that  the  transformation  is  nonsingular  as  long  as 
22  /  0  and  ziz2  — zjzi  ^  0.  In  the  original  coordinates, 
these  translate  to  r2  ^  0  and  r,r2  —  r2r,  0.  Since 
r2  refers  to  the  radius,  it  is  never  zero  during  the  mo¬ 
tion.  The  second  condition  implies  that  f,  ^  tzn.  any_ 
where  during  motion.  This  must  be  ensured  through 
the  choice  of  a  proper  trajectory. 

A  motion  plan  is  developed  using  the  following  bound¬ 
ary  conditions  for  the  trajectory  over  10  seconds  of 
time:  r, (0)  =  0.3,  r2(0)  =  0.3,  0,(0)  =  0,  02(O)  =  0; 
n(o)  =  0.02,  f2(o)  =  0.01,  0,(0)  =  0,  02(o)  =  o; 
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n(10)  =  0.4,  ra(10)  =  0.35,  0i(lO)  =  3,  02(1O)  =  3.25; 
17  (10)  =  0.015,  r2(10)  =  0.01,  0i (10)  =  0,  02(1O)  =  0. 
All  lengths  are  given  in  meters  and  all  angles  are  in 
radians. 

These  boundary  conditions  when  transformed  to  the 
space  of  flat  variables  give:  z\ (0)  =  0.3,  z2( 0)  =  0.3, 
z3( 0)  =  0;  z\ (0)  =  0.02,  *2(0)  =  0.01,  i3(0)  =  0; 
zx(10)  =  0.4,  z2(10)  =  0.35,  z3(10)  =  0.17857; 
Zi(10)  =  0.015,  «2(10)  =  0.01,  and  i3(10)  =  0.0306. 
The  flat  output  trajectories  were  chosen  to  be  cubic 
polynomials  in  time  using  these  boundary  conditions 
and  are  shown  in  Fig.  4.  On  transforming  these  tra¬ 
jectories  of  the  flat  outputs,  the  state  trajectories  are 
shown  in  Fig.  5. 


5  Feedback  Control 

From  the  model  of  the  system,  the  inputs  are  related 
to  the  flat  variables  as  follows: 

u\  =  n  =  ii  (34) 

n2  =  f2  =  z2  (35) 


where  7 4  are  functions  of  z  and  z.  In  order  to  obtain 
a  well  defined  relative  degree  with  respect  to  each  of 
the  outputs,  we  need  to  perform  a  prolongation  of  the 
inputs  in  the  model  by  defining  Ci  =  «i  and  C2  =  «2 
and 

'i\  =  Ci  =  vi  (33) 

Z2  =  C2  =  v'l  (39) 

z3  —  —  (113  —  71C1  —  72C2  —  74)  =  v3  (40) 
73 

With  this  extension  of  the  inputs,  each  output  has  a 
relative  degree  two  as  long  as  73 (z,z)  /  0.  Now,  the 
control  law  can  be  chosen  to  be  of  the  form 

Vi  —  iid  +  kvi(iid  —  ii)  +  kpi(zid  —  Zi) ,  i  1,2,3  (41) 

where  kvi  and  kpi  are  selected  gains  such  that  Zi(t) 
asymptotically  follows  za{t).  With  these  choices,  the 
input  rates  satisfy  the  following  relationships: 

ui  —  z\d  T  kv\  (zid  fj)  +  kpi  (zid  r*i )  (42) 
U2  =  %2d  +  kv2(z2d  —  r2)  +  kv2{z2d  ~  r2)  (43) 

113  =  7iiii  +  72^2  +  74 

+  73 [^3d  +  ^v3 {z-id  —  Z3)  +  kp;i(z3d  ~  -^3 )1  (44) 


An  example  of  an  implementation  of  the  feedback  con¬ 
troller  is  shown  in  Fig.  6.  The  initial  conditions  at  time 
t  —  0  were  chosen  as  77  =  0.29,  r2  =  0.305,  9 1  =  0, 
02  —  0;  h  =  0.02,  f2  =  0.01  so  that  the  initial  start¬ 
ing  point  is  not  on  the  given  reference  trajectory.  The 
feedback  gains  were  selected  as  kv  1  =  1.414,  kpl  =  10; 
kv 2  =  1.414,  kp2  =  10;  kv3  =  50,  kp 3  =  100.  As  shown 
in  the  plots,  the  trajectories  follow  closely  the  desired 
trajectory. 
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6  Conclusion 

The  paper  described  the  design,  modeling,  trajectory 
planning,  and  control  of  a  novel  4-wheel  vehicle  with 
expanding  wheels.  The  first  model  assumes  that  the 
vehicle  moves  along  a  straight  line  on  a  fait  floor  and 
the  contact  point  of  the  wheel  with  ground  is  directly 
underneath  the  center  of  the  wheel  and  has  no  slip. 
The  rolling  constraints  are  nonholonomic,  i.e. ,  are  non- 
integrable.  The  rate  constraints  were  written  in  an 
input-affine  drift-less  control  system.  The  structure 
of  this  drift-less  control  system  allows  to  determine 
the  differentially  flat  outputs  of  the  system.  Motion 
planning  of  the  vehicle  between  two  configurations  is 
achieved  through  planning  of  these  differentially  flat 
outputs.  These  trajectories  are  then  used  to  determine 
a  feedback  controller  and  simulated  in  MATLAB.  The 
motions  are  currently  being  implemented  on  the  phys¬ 
ical  hardware  using  a  dSPACE  control  system. 
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ABOKATWO 


Problem  Statement 


•  Develop  computationally  efficient  algorithms  for 
feasible  and/or  optimal  planning  of  dynamic 
systems. 


•  State  equations:  x  =  f(x)  +  g(x)u,  jeer,  we< Rm 

•  Path  and  end  constraints: 

Zj  <  w  <  T2 ,  p(x)<  0,  C (x, u)  <  0,  x(ti )  =  Xj 

•  Cost  functional:  J  =  \L{x,u,t)dt 

IQ 


Motivation 


7 


Differentially  Flat  or  Higher-Order  Systems 


•  Canonical  transformation  of  state  equations  using  linear  and 
nonlinear  systems  theory 


•  Controllable  linear  time-invariant  systems 

•  Classes  of  time-varying,  time-periodic  systems 

•  Feedback  linearizable  nonlinear  systems 

•  Classes  ofnonholonomic  systems 

•  Differentially  flat  systems 


Higher-Order  Systems:  Trivial  Examples 


Mq+  Dq  +  Kq  =  u 


u 

K 

D 

M 

9 

• 

9 

= 

1 

0 

0 

9 

9 

0 

I 

0 

9 

I.M 


lq\  +  MgL  sin  ~  <7  2  )  =  0 

J<ii  ~  *(?,  -  <?2)  =  u 

/  ..  MgL  . 

<?2  =  9i  +  +  -y- Sln  <7, 

u  =  Jq\  -k(qx  -q2) 


Non-trivial  Flat 


Systems:  Aircraft  Dynamics-^ 


V  = - g  sin  9 

m 

a=q~q  sec/!  - (p  cosa  +  r sina/  tan^ 
/?  -  r'  +  psina  -  r  cosa 
col  =  M(<i/,$,ij>)w' 

w  =  J~'wJu)  +  J~'T 


co\(D.L,S)  =  G(V  ,a,P)*F(V  ,a,P)P 
T  -  B(V ,a,p)  +  A(V ,a,  pf> 


p  =  pcosacosp +  (1/ -a)$\n  p +  rsmacosp 
q  =  “^{i-mgcos  <9cos^) 

r  (~S  +  m&'cos.9sin|S)  [Isidori  95] 
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J*. 

Differential-Flatness  of  Aircraft  Dynamics 


For  a  typical  Aircraft,  the  flat  outputs  are  x,y,z,4 

V=V(x,y,z) 

V'  =  V'(x,y,z) 

9  =  9(x,y,z) 
a  =  a(x,x,y,y,z,z,  4) 

P  =  P(x,x,y,y,z,z,4)  [Martin  96] 

P  =  P{x,x,y,y,z,z,4 ) 
a  =  as(x,  x,  x,  y,  y,  y,  z,  z,  z,  4, 4) 

5  =  6(x,  x,  x,  x(4>  ,y,y,  y,  y(>> ,  z,  z,  z,  z(4)  ,4, 4,4) 


Feasible  Trajectories  without  Inequalities 


Example 

Iq\  +  Mgi  sin  q,  +  k(q ,  -q,)=  0 
J<f,  ~  *(9t  -?:)=>' 

I  ..  MgL  . 

<h  =9, +  ^9, +  9, 

"  ~  Ji\  —  *<9t  -  9i) 


9.U„=0 
9.U,  =  1 

93U=0-»9,U=0 


9,  =( 

UgL  . 

q7  =  t  +  — A— sin/ 

ly  ,  .  JMgL  . 
u  =  MgL  srn  / - - — sin  / 


Optimal  Trajectories:  Feedback  Linear  Systems 


..5p  .  . 

yi  =  siyi.yi.  2/i  )  +bc 
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Example:  Flexible  Joint 


!/i 

V* 

Ni  +  Wyi bin(v,)  +  «.(vi  -  «)  -  0  Vj 

-  U</1  -  V!)  "  U  ^ 

y(!o) 

at  j  at  i2  at  _  ^  at  i4  at 

ay,  4t&Ji  +  dfi&jji  dfidyi  +  <f  t*  8  y, 

y:=  /(yi.yi.  ■  ■  ,yi) 

yi(0),yi(0),yi(0),yi  (0) 

yi(/),yi(/)iyi(/).yi3  (/) 


Experiment:  Free-floating  Robot 


t.  l’  t.'  1.  I; 


t‘S,  I!  •, 

b| 

I  rw<t*  •  »•»  ■  -  I 


Feasible  Planning:  Inequalities 


x  =  f(x)+g(x)u 

fy...?9l=^(i,S)  > 

Xy  )Xj 

'6['c'/] 

xeW^eW1 

< - S - - - 

- p 

c{x,u)  <0 

c(y,y,...,y)<0 

Polytopic  Approximation 


M3CL 

MM 
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Experi inent:  Predator-Prey 


x  -Ull.  y  +  ±-  f+y 
y  k2  k2 

.03 < x,  < .03  -.03^ jc,  < .03  umh<u<u, 

C[y  y  <  0 

y(0 = A  (0 + Vi  (0 + b2<f>i  (0 


Optimal  Planning:  Pontryagin’s  Extensions 


x  ‘Kr\  ti  €.  Piisi-Oidw  R»rm  Higlirf  OnVn  Form 

yr  v- 

Dynitntic  H<js.  x  ** • /(x)  +  9(2 )«  V  ^  ,  V  -v) 

Cost  Htiiaiottal  J  •»  £(x.  ti .  t)<it  J  «*  /2J  ,  V  ,  0rf- 

C  VsJtr.tr  aiiits  u,  t)  <  0  d(y,  V  ,  t)  £  0  . 


I.^rjarmc  r«q*. 
Goer  Function 

Const  ?x.;r»ia 
EarraHcJuar} 

M'Synt'"?plr 

O  utfit?*  fop. 


FUg;.-Or-ict  Form  i  High*:  -Order 

•  T^r,afc  .  s  t  t  1C* 

J  x(Oy  &  (sr  ?T  ••  Z^f 

7  -  }  fz.  «,  fj  ;  X  “  /  fo  S',  ...  V.V.l) _ _ _  J 

•t  4=  +  »,-')«  j  jf*&t/.tj)  +  Jfi5*.*.  • 

«(*•.«,  rt  <  0  ‘i  '.*.«>  S» 

«Cx,«,!)  =  t+.;r/  i  «(*.«.<}  =  1  +  »f,‘  -  A 

‘Kts.v'.'l  !?<(.. tiM)  =  raaK|<,5,  0 

iV'-K. . ! (-i)-7=  <-  .  - r-. 


Higher-Order  Toolboxes:  Direct  &  Indirect 


*  Parameterized  solution  of  higher-order  variable  and  inputs 


&  of  conditions;  tutwt  be 
satisfied  (N-inierva!) 

Higher-Order  (pM) 

Fir  il -Order (//  -  tip) 

1.  Continuity  &  Boundary 

2ttj>(N  + 1) 

V(i\41)„..(«| 

2.  Staflc  cobtalc  equations 
with  2  collocation  point  in 
each  interval 

Direct . . . .  2t»'A' 

Indirect . Aft'N 

J  (.towiminls 

2rN 

2rK . (umt) 

•  Use  NPSOL  to  solve  NLP  problem 

•  Features:  Direct/Indirect,  First-order/Higher-order,  General  cost.  Boundary  constraints, 
Automatic  gradient  computation,  First  integral  of  the  solution,  Matlab  Mex-file, 
Graphical  environment 
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New  Toolbox:  Computational  Comparisons 


System*  i 

j  CPU  run-time  (Second) 

1  Direct  Firet^crder  (I)  ] 

20  66 

2  Di«<t  Second-ooder  (II) 

vsao 

3  Direct  Fourth -order  (III)  j 

2  91 

4  Indirect  F»r»t- order  fl)  J 

99  74 

5  Indirect  Second -order  (11)  | 

2256 

(5  Indirect  Focrth-order  (Ifl)  ! 

!  IS  67 

New  Toolbox:  Computational  Comparisons 


;S /items 

CPU  run-time  (Second)  1 

!  I  Dinsei  First-order  (I) 

io  oo  ! 

** 

j  x  Direct  Second -ord*:  (11 J 

4  TOO  1 

■  5  Direct  Fourth -order  (III) 

2  350  1 

-• 

1  4  Indirect  First-order  (!) 

434  6  j 

|  $  Indirect  Second -order  (II) 

137  £ 

;  C  Indirect  Fourth-order  (III) 

5$  62  j 

“V 

Optimal  Planning  of  a  Group 


of  Flat  Systems 


v  _ 

min  |  L(xt.x 2 . xN,uvu2 . uN,t) 

s.t. 

%  =  Ifc.uJ,  i  =  1 N  -  System  dynamic  Eqs. 

g(x  . x  0  <  0,  g  g  91"'"  -  Configuration  constraints 

c(x,.  x2 . xN,  ux.  u2 . uN.t)  <  0 ,c  e  9Cf 

-  Path  and  actuator  const. 

•  Search  for  N(n+m)  functions,  Nn  state  Eqs.  +  inequalities 
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Planning  of  Groups:  Formation  Constraints  and  Flatness 


If  each  unit  is  differentially  flat  and  inequality  constraints  exhibit  a 
specific  structure 

x2=h1(xi.t) 

x,=h,(x„xyl)  _ 

y(x{,x2 . ,xN,l)  =  Oj  .  =* g(x,,x2 . xN,t)<  0 

xN  —  h2(x\,x2  ...,xN_x t) 

Entire  system  is  differentially  flat  because  the  trajectory  x,(t)  of  the 
first  unit  completely  determines  all  remaining  trajectories. 

We  plan  the  trajectory  of  the  leader, 


A 


A 


Example:  Differential  drive  mobile  robots 


Kinematic  equations: 


Xj  and  y;  are  the  flat  variables  for  each  robot.  Given  x;(t)  and 


yj(t),  the  remaining  states  and  inputs  are  determined  using 


Laboratory  Exp:  MPC-like  Strategy 
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Cable  Systems:  PDEs  and  5-flatncss 


•  Cable  continuum  models  are  PDEs  in  x  and  t 

•  Input-output  models  are  delay-differential  Eqs 

•  8-flatness  is  a  special  structure  of  the  DDEs. 

•  Compute  inputs  that  modify  flexural  behavior 

-  residual  motion  suppression  in  elevators 


^  =  ^,vrE(°,A) 

+BC 

+r,))] 

+  An*,(i,.')-»’,(t1.<-2r1)  +  *1(i1.i-2r,>-vi.1(i1./-2(r1  +  r,))J 
+  B[  w,  (i, ./)  -  »,(£,  .1  -  2r,  )  +  w,  (£,  ,i  -  2r, )  -  w(L,  ,1  -  2<r,  +  r, )) 
”2J«1(/-(r,  +2r,))-i/I(f-r,)] 


\ — -CjT 


Conclusions 


•  Higher-Order  approach  is  computationally  effective  for 
classes  of  dynamic  systems 

•  Potential  theoretical  and  Software  extensions,  Special 
purpose  toolboxes  for  vehicles,  robotics,  others... 

•  Flatness  and  coupling  of  dynamic  units  in  groups 
makes  the  computational  problem  more  tractable. 

•  Trajectory  plans  that  satisfy  the  system  dynamics  are 
better  executable  compared  to  geometric  plans. 
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IMPACT  OF  RIGID  AND  FLEXIBLE  MULTIBODY  SYSTEMS: 
DEFORMATION  DESCRIPTION  AND  CONTACT  MODELS 


J.A.C.  AMBROSIO 
IDMEC/Instituto  Superior  Tecnico 
Av.  Rovisco  Pais,  1049-001  Lisboa,  Portugal 
e-mail:  jorge@dem.  ist.  utl.pt 


1.  Introduction 

The  multibody  dynamics  methodologies  present  the  necessary  characteristics  to  model  systems  that 
experience  contact  and  impact  conditions.  The  study  of  the  biomechanics  of  impact  is  an  example  of  an  area 
where  the  multibody  biomechanical  models  have  dominated  the  numerical  procedures.  The  design  of  vehicles 
for  crashworthiness  has  also  relied  for  long  in  conceptual  models,  which  are  in  fact  multibody  models.  Other 
type  of  systems,  such  as  roller  chain  drives,  gear  drives  or  mechanisms  with  joint  clearances,  also  require  the 
description  of  the  contact  and  impact  between  the  system  components  and,  eventually,  the  deformation  of  those 
elements.  In  all  applications  of  multibody  dynamics  formulations  that  involve  contact  and  impact  it  is  required 
that  proper  contact  models  are  used,  the  numerical  integration  procedures  can  accommodate  the  sudden  change 
of  the  system  conditions  and  the  deformations  of  the  system  components  are  represented  such  a  way  that  the 
model  deformation  patterns  can  be  reproduced  by  the  model. 

The  design  requirements  of  advanced  mechanical  and  structural  systems  and  the  real-time  simulation  of 
complex  systems  exploit  the  ease  of  use  of  the  powerful  computational  resources  available  today  to  create  virtual 
prototyping  environments.  These  simulation  facilities  play  a  fundamental  role  in  the  study  of  systems  that 
undergo  large  rigid  body  motion  while  their  components  experience  material  or  geometric  nonlinear 
deformations.  The  standard  methodologies  are  unable  to  deal  with  systems  that  undergo  material  nonlinear 
deformations  and  consequently  are  not  useful  for  applications  involving  structural  impact  of  multibody  systems. 
To  overcome  these  limitations,  Nikravesh  and  Sung  [1]  suggested  a  rigid  body  description  of  the  multibody 
system  with  the  nonlinear  deformations  lumped  in  force  elements  acting  the  kinematic  joints  and  referred  to  as 
plastic  hinges.  This  technique,  further  developed  by  Ambrosio  and  Pereira  [2]  and  by  Dias  and  Pereira  [3],  is 
applicable  to  systems  for  which  the  pattern  of  deformation  can  be  assumed  beforehand. 

Using  reference  frames  fixed  to  planar  flexible  bodies,  Song  and  Haug  [4]  suggest  a  finite  element  based 
methodology,  which  yields  coupled  gross  rigid  body  motion  and  small  elastic  deformations.  The  idea  behind 
Song  and  Haug’s  approach  is  further  developed  and  generalized  by  Shabana  and  Wehage  [5,6]  that  use 
substructuring  and  the  mode  component  synthesis  to  reduce  the  number  of  generalized  coordinates  required  to 
represent  the  flexible  components.  Yoo  and  Haug  [7]  account  for  the  contribution  of  the  truncated  modes  by 
introducing  static  correction  modes. 

The  community  studying  space  dynamics  has  been  dealing  with  the  dynamics  of  flexible  bodies  undergoing 
large  rigid  body  motion.  The  orbiting  space  structural  systems  are  characterized  by  the  use  of  very  flexible 
lightweight  components.  The  need  to  characterize  dynamically  and  control  such  systems,  in  particular, 
motivated  valuable  investigations  on  flexible  multibody  dynamic  [8,9],  In  the  framework  of  the  spinning 
spacecrafts  modeling,  Kane,  Ryan  and  Banerjee  [10]  showed  that  though  most  of  the  flexible  multibody 
methods,  at  the  time,  could  capture  the  inertia  coupling  between  the  elastodynamics  of  the  system  components 
and  their  large  motion  but  they  would  still  produce  incorrect  results.  Actually,  the  floating  reference  frame 
methods  used  in  flexible  multibody  dynamics  have  the  ability  to  lower  the  geometric  nonlinearities  of  the 
flexible  bodies,  but  they  do  not  eliminate  them  because  the  moderate  rotation  assumption  about  the  floating 
reference  frame  is  still  required  [11].  Recognizing  the  problem  posed  and  using  some  of  the  approaches  well  in 
line  with  those  of  the  finite  element  community  Cardona  and  Geradin  proposed  formulations  for  the  nonlinear 
flexible  bodies  using  either  a  geometrically  exact  model  [12]  or  through  substructuring  [13].  Defining  it  as  an 
absolute  nodal  coordinate  formulation,  Shabana  [14]  used  finite  rotations  nodal  coordinates  enabling  the  capture 
of  the  geometric  nonlinear  deformations.  Another  approach  taken  by  Ambrosio  and  Nikravesh  [15]  to  model 
geometrically  nonlinear  flexible  bodies  is  to  relax  the  need  for  the  structures  to  exhibit  small  moderate  rotations 
about  the  floating  frame  by  using  an  incremental  finite  element  approach  within  the  flexible  body  description. 
The  approach  is  further  extended  to  handle  material  nonlinearities  of  flexible  multibody  systems  also  [16]. 

Applications  of  rigid  and  flexible  multibody  systems  to  impact  scenarios  require  an  efficient  description  of 
the  contact  conditions  [17,18].  Some  of  the  characteristics  required  from  these  contact  models,  in  a  multibody 
dynamics  framework,  concern  their  contribution  to  the  stable  integration  of  the  equations  of  motion,  the 
description  of  the  geometry  and  properties  of  the  surfaces  in  contact  and  the  correct  representation  energy 
dissipation  due  the  local  and  global  deformation  effects  not  modeled  by  the  flexible  bodies.  The  continuous 
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contact  force  model,  proposed  by  Lankarani  [19],  fulfills  the  required  characteristics  to  represent  both  nodal  and 
rigid  body  contact.  An  alternative  model,  using  the  addition  and  deletion  of  kinematic  constraints,  is  proposed 
for  the  nodal  contact  of  the  nonlinear  finite  elements  representing  the  flexible  components.  In  both  cases  of  rigid 
and  flexible  body  contact  the  dynamic  friction  forces  are  modeled. 

The  multibody  formulations,  able  to  describe  material  nonlinear  deformations  of  the  system  components  are 
reviewed  here.  Also,  two  methodologies  able  to  describe  efficiently  contact  in  multibody  systems  are  discussed 
in  this  work.  Finally,  the  methodologies  discussed  are  used  in  several  application  cases  that  involve  vehicle  and 
biomechanics  impact. 


2.  Equations  of  Motion  For  Multibody  Systems 

The  multibody  system  is  a  collection  of  rigid  and  flexible  bodies  joined  together  by  kinematic  joints  and 
force  elements,  as  shown  in  Fig.  1.  For  the  ;th  body  in  the  system  q,  denotes  a  vector  of  coordinates  which 
contains  the  Cartesian  translation  coordinates  r,  and  a  set  of  rotational  coordinates  p,.  A  vector  of  velocities  for  a 
rigid  body  i  is  defined  as  v„  which  contains  the  translation  velocities  r.  and  the  angular  velocities  to,.  The  vector 
of  accelerations  for  the  body  is  denoted  by  v,.  and  it  is  the  time  derivative  of  v,.  For  a  multibody  system  with  nb 
bodies,  the  vectors  of  coordinates,  velocities,  and  accelerations  are  q,  v  and  v  which  contain  the  elements  of  q„ 
v,  and  v, ,  respectively,  for  i=l,  ...,nb. 


Figure  1 .  Generic  multibody  system  in  an  impact  fictitious  scenario 
The  kinematic  joints  between  rigid  bodies  are  described  by  mr  kinematic  constraints 

*(q)  =  o  (i) 

The  time  derivatives  of  the  constraints  result  in  the  velocity  and  acceleration  equations. 

<i>  =  Dv  =  0  (2) 

=  Dv  +  Dv  =  0  (3) 

where  D  is  the  Jacobian  matrix  of  the  constraints.  The  constraint  equations  are  included  in  the  equations  of 
motion  using  the  Lagrange  multiplier  technique  [20] 

Mv-DrX  =  g  (4) 

where  M  is  the  inertia  matrix,  X  is  the  vector  of  Lagrange  multipliers,  and  g  =  g(q,  v)  has  the  gyroscopic  terms 
and  forces  and  moments  acting  on  the  rigid  and  flexible  bodies. 

The  solution  of  equation  (4)  together  with  equation  (3)  constitutes  the  set  of  differential-algebraic  equations 
that  represent  the  motion  of  the  multibody  system.  These  are  written  in  a  matrix  form  as 


MDHrvlJ  g 

d  o  J  L*J  L-i)1 


There  is  a  wide  range  of  multibody  systems  applications,  involving  impact,  that  can  use  models  made  solely 
of  rigid  bodies  but  that  still  have  a  representation  of  deformations,  using  the  plastic  hinge  concept  for  instance 


[1].  However,  many  applications  of  multibody  systems  that  require  the  description  of  the  system  deformation. 
The  use  of  flexible  multibody  models  that  include  the  description  of  the  large  deformations  of  the  system 
components  by  nonlinear  finite  elements  is  necessary  for  these  applications.  However,  before  a  methodology 
describing  the  distributed  flexibility  of  multibody  systems  is  presented  the  use  of  the  plastic  hinge  concept  in  the 
context  of  multibody  systems  models  to  impact  is  briefly  described  here. 

2.1.  PLASTIC  HINGES  FOR  MULTIBODY  NONLINEAR  DEFORMATIONS 

In  many  impact  situations,  the  individual  structural  members  are  overloaded,  principally  in  bending,  giving 
rise  to  plastic  deformations  in  highly  localized  regions,  called  plastic  hinges.  These  deformations,  presented  in 
Fig.  2,  develop  at  points  where  maximum  bending  moments  occur,  load  application  points,  joints  or  locally  weak 
areas  [21]  and,  therefore,  for  most  practical  situations,  their  location  is  predicted  well  in  advance.  Multibody 
models  obtained  with  this  method  are  relatively  simple.  This  methodology  is  known  in  the  automotive,  naval  and 
aerospace  industries  as  conceptual  modeling  [1,22,23], 
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Figure  2.  Localized  deformations  on  a  beam  and  a  plastic  hinge 


The  plastic  hinge  concept  has  been  developed  by  using  generalized  spring  elements  to  represent  constitutive 
characteristics  of  localized  plastic  deformation  of  beams  and  kinematic  joints  [2],  as  illustrated  in  Fig.  3.  The 
characteristics  of  the  spring-damper  that  describe  the  properties  of  the  plastic  hinge  are  obtained  by  experimental 
component  testing,  finite  element  nonlinear  analysis  or  simplified  analytical  methods.  For  a  flexural  plastic  hinge 
the  spring  stiffness  is  expressed  as  a  function  of  the  change  of  the  relative  angle  between  two  adjacent  bodies 
connected  by  the  plastic  hinge,  as  shown  in  Fig.  4. 


(c)  (d) 


Figure  3.  :Plastic  hinge  models  for  different  loading  conditions:  a)  one  axis  bending  b)  two  axis  bending;  c)  torsion;  d)  axial  loading 

For  a  bending  plastic  hinge  the  revolute  joint  axis  must  be  perpendicular  to  the  neutral  axis  of  the  beam  and 
to  the  plastic  hinge  bending  plane.  The  relative  angle  between  the  adjacent  bodies  measured  in  the  bending  plane 
is: 

e,  =  di-eJ-^  (6) 

where  6*/  is  the  initial  relative  angle  between  the  adjacent  bodies. 


Figure  4.  Plastic  hinge  bending  moment  and  its  constitutive  relationship 
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The  typical  torque-angle  constitutive  relationship,  as  in  Fig.  4,  is  found  based  on  a  kinematic  folding  model 
[24]  for  the  case  of  a  steel  tubular  cross  section.  This  model  is  modified  accounting  for  elastic-plastic  material 
properties  including  strain  hardening  and  strain  rate  sensitivity  of  some  materials.  A  dynamic  correction  factor  is 
used  to  account  for  the  strain  rate  sensitivity  [25], 

Pi  IP,  =  1  +  0.07  V°*2  (7) 

Here  Pd  and  Ps  are  the  dynamic  and  static  forces,  respectively,  and  V0  is  the  relative  velocity  between  the 
adjacent  bodies.  The  coefficients  appearing  in  Eq.  (7)  are  dependent  on  the  type  of  cross  section  and  material. 


3.  Flexible  Multibody  Systems 

Though  the  use  of  crushable  elements  or  plastic  hinges  can  be  a  valuable  approach  they  require  that  the 
pattern  of  deformation  of  the  structural  component  is  known  in  advance.  In  complex  cases,  eventually  involving 
multiple  impacts,  it  is  not  possible  to  predict  the  loading  of  the  vehicle  structural  components.  Therefore,  the  use 
of  a  nonlinear  finite  element  description  is  irreplaceable  [26], 

3.1.  EQUATIONS  OF  MOTION  FOR  A  SINGLE  FLEXIBLE  BODY 

The  motion  of  a  flexible  body,  depicted  by  Fig.  5,  is  characterized  by  a  continuous  change  of  its  shape  and 
by  large  displacements  and  rotations,  associated  to  the  gross  rigid  body  motion.  Let  XYZ  denote  the  inertial 
reference  frame  and  ^  a  body  fixed  coordinate  frame.  Let  the  principle  of  the  virtual  works  be  used  to  express 
the  equilibrium  of  the  flexible  body  in  the  current  configuration  t+At  and  an  updated  Lagrangean  formulation  be 
used  to  obtain  the  equations  of  motion  of  the  flexible  body  [26], 

Let  the  finite  element  method  be  used  to  represent  the  equations  of  motion  of  the  flexible  body.  The  finite 
elements  used  in  the  discretization  of  the  flexible  body  are  assembled,  leading  to  the  body  equations  of  motion. 
In  order  to  improve  the  numerical  efficiency  of  the  solution  of  the  equations  obtained,  a  lumped  mass 
formulation  is  used  and  the  nodal  accelerations  ii',  measured  with  respect  to  the  body  fixed  frame,  are 
substituted  by  the  nodal  accelerations  relative  to  the  inertial  frame  qj  .  Furthermore,  it  is  assumed  that  the  flexible 
body  has  a  rigid  and  a  flexible  part  and  that  the  body  fixed  coordinate  frame  is  attached  to  the  center  of  mass  of  the 
rigid  part,  as  shown  in  Fig.  6.  The  flexible  and  rigid  parts  are  attached  by  the  boundary  nodes  \f/.  The  procedure  is 
described  in  Ambrosio  and 


Nikravesh  [26],  The  resulting  equations  of  motion  for  the  flexible  body  are  written  as 
nil  +  AM*  A r  -AM*S  0 

-(am‘s)t  J'  +  SrM*S  0 

0  0 

where  r  and  6'  are  respectively  the  translational  and  angular  accelerations  of  the  body  fixed  reference  frame,  J' 
is  the  inertia  tensor,  expressed  in  body  fixed  coordinates,  fr  is  the  vector  of  the  external  forces  applied  on  the 
body  and  n'  is  the  a  vector  with  the  force  transport  and  external  moments.  Vector  u'  denotes  the  displacements 
increments  from  a  previous  configuration  to  the  current  configuration,  measured  in  body  fixed  coordinates.  The 
right-hand  side  of  Eq.  (8)  contains,  the  vector  generalized  forces  applied  on  the  deformable  body  g,  matrices  KA 
and  K,vl,  which  are  the  linear  and  nonlinear  stiffness  matrices  respectively,  and  f  denotes  the  vector  of  equivalent 
nodal  forces  due  to  the  state  of  stress.  The  reference  to  the  linearity  of  the  stiffness  matrices  K*.  and  KNL  is 
related  to  their  relation  with  the  displacements. 


r 

fr+AC' 

<b' 

= 

n'-d>'jv-src;-irc; 

3'f. 

g'f-f-{KL  +  KNL)  u' 
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Figure  6.  Flexible  body  with  a  rigid  part 

In  Eq.  (8)  M*  is  a  diagonal  mass  matrix  containing  the  mass  of  the  boundary  nodes,  and 

\T  =[aa— A]r;  s  =  [(x;  +  5;  )r (x;  +  S;  )r  •  •  •(*;  +  S;  )r  J ;  I  =  [ii-if 

Here  A  is  the  transformation  matrix  from  the  body  fixed  to  global  coordinate  coordinates  and  x*  denotes  the 
position  of  node  k.  Vectors  and  C'e  are  the  reaction  force  and  moment  of  the  flexible  part  of  the  body  over 
the  rigid  part  respectively,  given  by 

C'  =  g'  - F,  - (Kl  +  Knl )sj  8' - (Kl  +Knl )ee  0'  (9) 

C,  =  g'e  -Ffl  -(K£  +KNL)gs  8'-(Kl+Knl)w  0'  (10) 


In  these  equations,  the  subscripts  S  and  &  refer  to  the  partition  of  the  vectors  and  matrices  with  respect  to  the 
translation  and  rotational  nodal  degrees  of  freedom.  The  underlined  subscripts  are  referred  to  nodal 
displacements  of  the  nodes  fixed  to  the  rigid  part. 


4.  Contact  Models 

The  description  of  any  crash  phenomena  is  strongly  dependent  on  the  contact/impact  model  used  to  describe 
the  interaction  between  the  system  components.  These  contact  models  must  not  only  be  formulated  in  a  form 
compatible  with  the  multibody  description  used  but  also  allow  for  the  representation  of  the  local  deformations, 
friction  forces,  energy  dissipation  and  still  contribute  for  the  stability  of  the  numerical  methods  involved. 

4.1.  CONTACT  DETECTION 

Let  the  flexible  body  approach  a  surface  during  the  motion  of  the  multibody  system,  as  represented  in  Fig. 
7.  Without  lack  of  generality,  let  the  impacting  surface  be  described  by  a  mesh  of  triangle  patches.  In  particular, 
let  the  triangular  patch,  where  node  k  of  the  flexible  body  will  impact,  be  defined  by  points  i,j  and  l.  The  normal 
to  the  outside  surface  of  the  contact  patch  is  n  =  rif  x  rjt . 

Let  the  position  of  the  structural  node  k  with  respect  to  point  i  of  the  surface  be 

=  r*-H  (11) 

This  vector  is  decomposed  in  its  tangential  component,  which  locates  point  k*  in  the  patch  surface,  and  a 
normal  component,  given  respectively  by 

■i  =  ■»  -(4  ")"  <l2> 

(13) 

A  necessary  condition  for  contact  is  that  node  k  penetrates  the  surface  of  the  patch,  i.e. 

r>  <  0  (14) 

In  order  to  ensure  that  a  node  does  not  penetrate  the  surface  through  its  ‘interior’  face  a  thickness  e  must  be 
associated  to  the  patch.  The  thickness  penetration  condition  is 

-rjk  n  <  e  (15) 
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Figure  7.  Contact  detection  between  a  finite  element  node  and  a  surface 


The  condition  described  by  equation  (15)  prevents  that  penetration  is  detected  when  the  flexible  body  is  far 
away,  behind  the  contact  surface.  The  remaining  necessary  conditions  for  contact  results  from  the  need  for  the 
node  to  be  inside  of  the  triangular  patch,  which  are 

tef"  *  0  ;  (f»r,/)rn  >  o  and  (rX./n  >  0  (36) 

Equations  (14)  through  (16)  are  necessary  conditions  for  contact.  However,  depending  on  the  contact  force 
model  actually  used,  they  may  not  be  sufficient. 

The  contact  detection  algorithm  is  applicable  to  rigid  body  contact  by  using  a  rigid  body  point  P  instead  of 
node  k  in  equation  (11).  The  global  position  of  point  P  is  given  by  rf  =  r,  +A,sf ,  where  sf  denotes  the  point 
location  in  body  i  frame. 

4.2.  CONTINUOUS  FORCE  MODEL 


A  model  for  the  contact  force  must  consider  the  material  and  geometric  properties  of  the  surfaces, 
contribute  to  a  stable  integration  and  account  for  some  level  of  energy  dissipation.  Based  on  a  Hertzian 
description  of  the  contact  forces  between  two  solids,  Lankarani  and  Nikravesh  [19]  propose  a  continuous  force 
contact  model  that  accounts  for  energy  dissipation  during  impact. 

Let  the  contact  force  between  two  bodies  or  a  system  component  and  an  external  object  be  a  function  of  the 
pseudo-penetration  8  and  pseudo-velocity  of  penetration  8 

f ■,i=(K5"+D8)  u  (17) 

where  K  is  the  equivalent  stiffness,  D  is  a  damping  coefficient  and  u  is  a  unit  vector  normal  to  the  impacting 

surfaces.  The  hysteresis  dissipation  is  introduced  in  equation  (17)  by  D  8 ,  being  the  damping  coefficient  written 
as 


D  = 


3/f(l-e2) 

4 


8" 


(18) 


This  coefficient  is  a  function  of  the  impact  velocity  5(^ ,  stiffness  of  the  contacting  surfaces  and  restitution 
coefficient  e.  The  generalized  stiffness  coefficient  K  depends  on  the  geometry  material  properties  of  the  surfaces  in 
contact.  For  the  contact  between  a  sphere  and  a  flat  surface  the  stiffness  is  [27] 

r(  i-v2  l-vJY' 

K  =  0.424%/?-  -~L+ - J-  n91 

l  ^  «Ej  )  (19) 


where  v,  and  E,  are  the  Poisson’s  ratio  and  the  Young’s  modulus  associated  to  each  surface  and  r  is  the  radius  of 
the  impacting  sphere. 

The  nonlinear  contact  force  is  obtained  by  substituting  equation  (18)  into  equation  (17) 


f ,,=K  8‘ 


LWil, 

4  8 (_) 


(20) 


This  equation  is  valid  for  impact  conditions,  in  which  the  contacting  velocities  are  lower  than  the  propagation 
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speed  of  elastic  waves,  i.e.,  8 <_)  <  10-5  Ej p 


4.3.  FRICTION  FORCES 

The  contact  forces  between  the  node  and  the  surface  include  friction  forces  modeled  using  Coulomb 
friction.  The  dynamic  friction  forces  in  the  presence  of  sliding  are  given  by 

f/r,c,i0”  =  -^/rf(|f;|/|q*|)q4  (2i) 

where  pd  is  the  dynamic  friction  coefficient,  and  qt  is  the  velocity  of  node  k.  The  dynamic  correction 
coefficient fd  is  expressed  as 

0  if 

fd  =  •(|qt|-v0)/(v,-v0)  if  v0  <  |q4 1  <  v,  (22) 

i  if  |q*|^vi 

The  dynamic  correction  factor  prevents  that  the  friction  force  changes  direction  for  almost  null  values  of  the 
nodal  tangential  velocity,  which  is  perceived  by  the  integration  algorithm  as  a  dynamic  response  with  high 
frequency  contents,  forcing  it  to  reduce  the  time  step  size. 

The  friction  model  represented  by  equation  (21)  does  not  account  for  the  adherence  between  the  node  and 
the  contact  surface.  The  interested  reader  is  referred  to  the  work  of  Wu,  Yang  and  Haug  [28]  where  stiction  and 
sliding  in  multibody  dynamics  is  discussed. 

4.4.  CONTACT  MODELS  USING  UNILATERAL  CONSTRAINTS 

If  contact  between  a  node  and  a  surface  is  detected,  a  kinematic  constraint  is  imposed.  Assuming  fully 
plastic  nodal  contact,  the  normal  components  of  the  node  k  velocity  and  acceleration,  with  respect  to  the  surface, 
are  null  during  contact.  Therefore  the  global  nodal  velocity  and  acceleration  of  node  k,  in  the  event  of  contact, 
become 

q*  =  -(q(r>rn)n  (23) 

q *  =  q^-fq^n)  n  (24) 

where  qjf*  and  q^1  represent  the  nodal  velocity  and  acceleration  immediately  before  impact. 

The  kinematic  constraint  implied  by  equations  (23)  and  (24)  is  removed  when  the  normal  reaction  force 
between  the  node  and  the  surface  becomes  opposite  to  the  surface  normal.  Representing  by  fk  the  resultant  of 
forces  applied  over  node  k,  except  for  the  surface  reaction  forces  but  including  the  internal  structural  forces  due 
to  the  flexible  body  stiffness,  the  kinematic  constraint  over  node  k  is  removed  when 

Vk  =  -fk  n  >  0  (25) 

This  model  is  not  suitable  to  be  used  with  rigid  body  contact.  The  sudden  change  of  the  rigid  body  velocity 
and  acceleration  would  imply  that  the  velocity  and  acceleration  equations  resulting  from  the  kinematic 
constraints  would  not  be  fulfilled.  Consequently  constraint  violations  would  develop  throughout  the  integration 
of  the  state  variables  and  the  analysis  would  fail.  The  friction  forces  can  still  be  included  when  using  this  contact 
model.  However,  as  the  normal  contact  reaction  forces  fk  are  calculated  using  the  Lagrange  multipliers,  the 
friction  forces  would  be  only  approximate  forces. 

4.5.  EXAMPLE  OF  IMPACT  OF  AN  ELASTIC  BEAM 

The  contact  force  models  are  exemplified  with  the  oblique  impact  of  a  hyperelastic  beam  against  a  rigid 
wall.  The  impact  scenario,  proposed  by  Orden  and  Goicolea  [29],  is  described  in  Fig  8.  The  beam,  with  a  mass 
of  20  kg,  length  of  1  m  and  a  circular  cross-section,  is  made  of  a  material  with  an  elastic  modulus  of  i?=108  Pa, 
Poisson’s  ration  of  v=  0.27  and  a  mass  density  of  p=  7850  kg/m3.  For  this  geometry  and  material  properties  the 
equivalent  stiffness  coefficient  used  in  equation  (20)  is  K=  1 .2  10s  kg/m2/3. 

The  motion  of  the  impacting  beam  is  shown  in  Fig.  9  together  with  that  of  a  rigid  bar  with  similar  inertia.  In 
Fig.  10,  the  contact  forces  developed  during  nodal  impact  are  presented.  The  motion  predicted  for  the  beam 
model  using  10  elements  is  similar  to  that  presented  by  Orden  and  Goicolea  [29]  for  a  model  made  of  20 
elements  and  using  an  energy-momentum  formulation  to  describe  contact. 
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Figure  8.  Impact  scenario  for  an  oblique  elastic  beam 


A  integration  algorithm  with  variable  time-step  is  used  to  integrate  the  equations  of  motion.  The  size  of  the 
integration  time-step  is  controlled,  during  contact,  by  the  time  of  travel  of  the  elastic  wave  across  one  element, 
which  is  Te=4A  lO’4  s  for  20  elements  [29],  Outside  of  contact,  the  integration  time-step  is  controlled  by  the 
system  response,  generally  associated  to  the  flexible  body  higher  frequencies.  Table  1  shows  the  average  time 
step  taken  by  the  algorithm  in  the  various  phases  of  the  system  motion. 


Table  1.  Average  time-step  of  the  integration  algorithm 


Type  of  contact 
model 

Beam  model 

Avg.  time- step 
before  contact 

Avg.  time-step 
during  contact 

Avg.  time-step 
after  contact 

Continuous  force 

4  elements 

0.60  10'3 

0.20  10‘3 

0.55  10'3 

Continuous  force 

10  elements 

0.24  10'3 

0.15  10'3 

0.20  10‘3 

Continuous  force 

20  elements 

0.43  10-4 

0.34  10-4 

0.40  104 

Kinematic  constraint 

4  elements 

0.60  10'3 

0.20  10'4 

0.55  10'3 

Kinematic  constraint 

1 0  elements 

0.24  10‘3 

0.74  10'5 

0.20  10‘3 

10000 


100 


(c.f.mVii=0)  node  1 
(c.f.m/u=0)  node  2 
(Rigid/u=0)  node  1 
(c.f.m/u=35)  node  1 
(Rjgid/u=0)  node  2 
- (c.f.m/u=35)  node  1 


Time  (s) 


Figure  1 0.  Forces  developed  between  the  (10  elements)  beam  end  nodes  and  the  rigid  surface  (c.f.m.  -  continuous  force  model;  k.c.  - 

kinematic  constraint  model) 

Observing  the  contact  forces,  shown  in  Fig.  10,  it  is  clear  that  the  impact  phenomena  occurs  with  multiple 
contacts.  Each  of  these  contacts  lasts  0.02  s,  in  average,  which  is  similar  to  the  contact  duration  of  0.018  s 
estimated  by  Orden  and  Goicolea  [29]  using  the  elastic  wave  travel  time  across  the  bar  length. 


5.  Application  To  Train  Impact 


The  application  of  the  methodologies  using  only  rigid  multibody  systems  to  train  crashworthiness  is 
exemplified  by  the  study  of  a  new  anti-climber  device  for  the  interface  between  the  cars  of  a  train.  This  device, 
which  ensures  that  train  cars  remain  aligned  during  the  crash,  has  been  developed  within  the  BRITE-EURAM 
project  SAFETRAIN  [30]  and  the  analysis  is  described  in  detail  by  Milho,  Ambrosio  and  Pereira  in  references 
[31,32], 
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0.0  s 


Figure  9.  Frictionless  impact  of  a  hyperelastic  beam  in  a  rigid  surface:  (a)  Beam  model  with  4  finite  elements;  (b)  Model  using  10  elements; 

(c)  f.e.m.  model  with  20  elements 


5.1.  RAILWAY  CRASHWORTHINESS 

The  methodology  developed  here  is  applied  to  the  simulation  of  a  train  collision.  Table  2  presents  the 
arrangement  of  a  train  set  with  eight  individual  car-bodies  and  it  includes  the  length  and  the  mass  of  each  one  of 
them  while  in  Fig.  11  the  topology  of  each  individual  car  is  shown.  Five  rigid  bodies,  B,  through  B5,  which 
represent  the  passenger  compartment,  boggie  chassis  and  deformable  end  extremities,  are  used  in  the  car-body 
model.  The  inertia  and  mechanical  properties  of  the  system  components  are  described  in  reference  [31]. 
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Table  2.  Train  set  pattern 
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The  high-energy  zones  (HE)  are  located  in  the  extremities  of  the  train  set  in  the  frontal  zone  of  the  motor 
car-body  and  in  the  opposing  back  zone,  in  the  last  car-body.  The  HE  are  potential  impact  extremities  between 
two  train  sets.  The  low-energy  zones  (LE)  are  located  in  the  remaining  extremities  of  the  train  car-bodies  and 
correspond  to  regions  of  contact  between  cars  of  the  same  train  set. 


Figure  1 1 .  Car-body  model  for  a  single  car 

The  objective  is  to  identify,  in  the  first  design  stage,  the  impact  kinematics  and  the  general  forces  developed 
during  collision.  In  the  second  design  stage  the  energy  absorbing  devices  at  the  vehicle  ends  are  defined,  and  the 
models  simulated  and  validated. 

The  first  simulation  scenarios  are  characterized  by  a  moving  train,  with  velocities  of  30,  40  and  55  km/h, 
which  collides  with  another  train  that  is  parked  with  brakes  applied.  Of  importance  to  the  anti-climber  design  are 
the  simulation  results  for  the  contact  forces  and  the  relative  displacements  between  car-bodies  extremities  [31], 

The  vertical  relative  displacement  between  the  points  of  the  contact  surfaces  defining  the  anti-climber  devices 
is  described  by  the  distance  g  measured  along  the  contact  surface,  see  Fig.  12.  This  displacement  is  calculated  when 
contact  between  the  end  extremities  of  the  car-bodies  occurs.  The  vertical  relative  displacement  in  the  interfaces 
between  car-bodies  obtained  is  illustrated  in  Fig  13. 


Figure  12.  Anti-climber  device  contact  geometry 

The  tangential  force  in  the  anti-climber  device,  illustrated  in  Fig.  14,  is  described  as  the  tangential 
component  of  the  contact  force  between  the  end  extremities  of  the  car-bodies.  It  is  observed  that  the  tangential 
force  at  the  interfaces,  tend  to  increase  both  in  magnitude  and  frequency  in  the  final  stage  of  the  train  impact. 

In  a  second  design  stage  the  conceptual  railway  vehicle  model  presented  herein  is  simulated  in  a  train  crash 
scenario  similar  to  that  of  an  experimental  test  performed  to  validate  a  low-energy  end  design  developed  within 
the  framework  of  Brite/Euram  III  project  SAFETRAIN  [30],  The  experimental  test  consists  in  having  a  vehicle 
moving  with  a  velocity  of  54  Km/h  toward  a  composition  with  two  vehicles  stopped  on  the  railroad,  as  depicted 
in  Fig.  15.  The  two  stopped  vehicles  are  equipped  with  the  low-energy  ends  and  connected  by  a  coupler  device 
Vehicle  C  is  also  equipped  with  a  high-energy  device  in  the  colliding  end.  The  vehicles  were  instrumented  in 
order  to  measure  accelerations,  forces  transmitted  in  the  buffers  and  coupler  and  relative  displacements  between 
system  components. 

The  force  time  history  for  the  buffers  of  wagon  A  is  displayed  in  Fig.  16  for  both  the  simulation  and  the 
experimental  test.  Note  that  the  experimental  test  results  are  plotted  for  a  single  buffer  while  the  expected  force 
resulting  from  the  simulation  is  shown  for  the  cumulative  effects  of  the  two  buffers  of  wagon  A. 
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Figure  13.  Vertical  relative  displacement  between  car-bodies  in  the  interfaces 


Figure  14.  Maximum  tangential  force  along  the  interfaces 
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Figure  15.  Collision  scenario  used  in  the  numerical  simulations  and  in  the  experimental  test 


Figure  1 6.  Force-time  history  of  the  buffers  of  wagon  A  (half  of  the  force  magnitude  on  the  buffers  is  compared  with  the  force  measured  in 

the  left  buffer  of  wagon  A) 

The  force  displacement  history  for  the  buffers  of  wagon  A  and  wagon  C  are  displayed  in  Fig.  17.  There,  it 
is  observed  that  deformation  predicted  for  the  buffers  of  wagon  C  is  a  higher  than  that  of  wagon  A.  The  buffer 
of  wagon  C  is  expected  to  be  fully  crushed. 
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Displacement  (mm) 

Figure  17.  Forces  experienced  by  the  buffers  of  wagon  A  and  C  during  the  simulation 

The  velocities  of  the  three  cars  during  the  simulation  are  plotted  in  Fig.  18.  There  it  can  be  observed  that 
the  velocities  predicted  by  the  model  are  very  similar  to  those  observed  in  the  experimental  test.  The  contact 
between  wagon  A  and  C  is  predicted  to  happen  with  no  initial  vertical  gap  between  the  buffers,  as  shown  in  Fig. 
19.  However,  as  the  buffers  approach  each  other,  the  vertical  gap  between  the  wagons  increases,  reaching  a 
maximum  of  15  mm.  The  vertical  forces,  that  the  buffers  have  to  support  in  order  to  prevent  overriding, 
presented  in  Fig.  19,  oscillate  with  a  maximum  peak  of  15  ton. 


Figure  18.  Time  history  for  the  wagons  in  the  simulation  and  experimental  test 


Figure  19.  Time  history  of  the  gap  and  vertical  contact  forces  in  the  buffers 

The  model  presented  for  the  preliminary  design  of  the  railway  vehicle  energy  absorbing  devices,  is 
improved,  based  on  the  results  obtained.  The  crushable  structural  elements  mechanical  characteristics  are 
improved  and  the  new  force  displacement  curves  implemented  in  the  model.  The  procedure  used  is  explained  in 
detail  in  reference  [32] 
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5.2.  APPLICATION  CASE  :  VEHICLE  ROLLOVER  WITH  OCCUPANTS 


The  scenario  in  which  the  methodology  described  in  this  work  is  demonstrated  is  a  rollover  situation, 
depicted  by  Fig.  20,  first  proposed  by  Ambrosio,  Nikravesh  and  Pereira  [33],  This  crash  case  is  characterized  by 
the  existence  of  multiple  impacts  and  by  a  complex  interaction  among  the  vehicle,  occupants  and  ground  that  can 
hardly  be  represented  by  the  more  traditional  approach  of  simulating  the  vehicle  rollover  first  and  then  using  the 
crash  pulse  as  input  for  the  occupants  dynamic  analysis.  For  more  details  on  this  application,  the  interested 
reader  is  referred  to  [34]. 


Figure  20.  Rollover  crash  scenario. 


5.2.1.  Biomechanical  Model  For  The  Vehicle  Occupants 

For  the  representation  of  the  vehicle  occupants  a  suitable  whole-body  response  biomechanical  model  is 
required.  The  biomechanical  model,  presented  by  Silva,  Ambrosio  and  Pereira  [35],  includes  12  anatomic 
segments  being  the  relative  motion  between  adjacent  bodies  limited  to  be  inside  generalized  cones  of  feasible 
motion.  The  model,  pictured  in  Fig.  21,  is  general  and  accepts  data  for  any  individual. 


(a)  (b)  (c) 

Figure  21.  Three-dimensional  biomechanical  model  for  impact:  (a)  actual  model;  (b)  local  referential  locations;  (c)  dimensions  of  the 

biomechanical  segments. 

In  contact/impact  simulations  the  relative  kinematics  of  the  head- neck  and  torso  are  important  to  the  correct 
evaluation  of  the  loads  transmitted  to  the  human  body.  Consequently,  the  head  and  neck  are  modeled  as  separate 
bodies  and  the  torso  is  divided  in  two  bodies.  The  hands  and  feet  do  not  play  a  significant  role  in  this  type  of 
problems  and  consequently  are  not  modeled  independently  of  the  adjacent  segments.  In  the  biomechanical  model 
no  muscle  activation  is  considered  but  the  muscle  passive  behavior  is  represented  by  joint  resistance  torques. 
Physically  unacceptable  positions  of  the  body  segments  are  prevented  by  applying  a  set  of  penalty  torques  when 
adjacent  segments  of  the  biomechanical  model  reach  the  limit  of  their  relative  range  of  motion.  The  moment 
penalizing  torque  increases  rapidly,  from  zero  to  a  maximum  value,  when  the  two  bodies  interconnected  by  that 
joint,  reach  physically  unacceptable  positions.  Details  of  this  model  can  be  found  on  reference  [35]. 

A  set  of  contact  surfaces  is  also  defined  for  the  calculation  of  the  external  forces  exerted  on  the  model  when 
the  surfaces  of  the  bodies  contact  other  objects  or  different  body  segments.  These  surfaces  are  ellipsoids  and 
cylinders  with  the  form  depicted  by  Fig.  22.  When  contact  between  components  of  the  biomechanical  model  is 


27 


The  multibody  dynamic  analysis  of  the  vehicle  and  occupant  in  a  crash  scenario  requires  that  the  initial 
positions  and  velocities  of  the  system  components  are  available.  In  order  obtain  these  conditions  for  realistic 
occupant  positions  a  process  of  recording  the  human  body  actual  motion  and  to  extract  the  position  of  its 
anatomical  segments  for  every  frame,  designated  by  spatial  reconstruction,  is  used  here  [36,37],  The  most 
frequently  used  technique  is  photogrammetry,  in  which  video  cameras  are  used  [37],  The  laboratory  apparatus 
of  cameras  is  schematically  represented  in  Fig.  23. 


Figure  23.  Vehicle  and  video  cameras  for  the  recording  of  the  out-of-position  occupants. 

The  images  collected  by  a  single  camera  are  collections  of  two-dimensional  information,  resulting  from  the 
projection  of  a  three-dimensional  space  into  a  two-dimensional  one.  Aziz  and  Karara  [38],  proposed  a  solution 
for  the  reconstruction  process  called  Direct  Linear  Transformation.  This  method  uses  the  two-dimensional 
information,  collected  by  two  or  more  cameras,  to  reconstruct  the  coordinates  of  the  anatomical  points. 

The  biomechanical  model  used  in  this  work  requires  the  reconstruction  of  the  spatial  position  of  the  23 
anatomical  points  depicted  in  Fig.  24  for  each  frame  of  the  analysis  period.  The  spatial  position  and  orientation 
of  the  anatomical  segments  of  the  biomechanical  model  are  obtained  from  the  spatial  positions  of  these 
reconstructed  points. 

With  the  setup  described  in  Fig.  23  a  seated  occupant  is  asked  to  adopt  seated  positions  similar  to  those  that 
would  be  used  when  riding  car  in  different  situations.  Among  those,  which  are  videotaped  and  reconstructed,  the 
positions  presented  in  Fig.  24  are  selected  and  used  in  the  application  of  the  methodology  to  a  vehicle  rollover. 

5.2.3.  Vehicle  And  Occupants  Integrated  Simulation 

The  vehicle  rollover  has  been  extensively  analyzed  with  the  purpose  of  studying  the  rollbar  cage  influence 
in  the  vehicle  stability  and  its  structural  integrity.  Here,  the  rollbar  cage  deformation  is  not  included  in  the  model 
though  its  deformations  are  implicitly  described  by  the  force  contact  model.  Three  50%tile  occupants,  are  also 
modeled  and  integrated  with  the  vehicle.  The  two  occupants  in  the  front  of  the  vehicle  have  shoulder  and  lap  seat 
belts,  described  with  the  model  proposed  by  Laananen,  Bolusbasi  and  Coltman  [39],  while  the  occupant  seated  in 
the  back  of  the  vehicle  has  no  seatbelt.  The  initial  positions  of  the  occupants  correspond  to  a  normally  seated 
driver,  a  front  passenger  that  is  bent  according  to  the  position  reconstructed  and  shown  in  Fig.  25,  and  a  rear 
occupant  with  a  ‘relaxed’  position,  also  reconstructed  and  presented  in  Fig.  25.  The  vehicle  and  occupants  are 
simulated  here  in  a  rollover  situation  described  in  Fig.  26. 
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Figure  24.  Set  of  20  digitized  points  and  kinematic  structure. 


(a)  (b)  (c)  (d)  (e) 

Figure  25.  (a)-(d)  Out-of-position  occupants  as  viewed  by  the  cameras  and  (e)  spatial  reconstructions. 


Figure  26.  Initial  position  of  the  vehicle  and  occupants  for  the  rollover 

The  results  of  this  simulation  are  pictured  in  Fig.  27,  where  several  frames  of  the  animation  of  the  vehicle 
rollover  with  occupants  are  presented.  It  is  noticeable  in  this  sequence  that  the  vehicle  first  impacts  the  ground 
with  its  left  tires.  At  this  point  the  rear  occupant  is  ejected.  The  rollover  motion  of  the  vehicle  proceeds  with  an 
increasing  angular  velocity,  mainly  due  to  the  ground  -  tire  contact  friction  forces.  The  occupants  in  the  front  of 
the  vehicle  are  hold  in  place  by  the  seat  belts.  Upon  continuing  its  roll  motion,  the  vehicle  impacts  the  ground 
with  its  rollbar  cage,  while  the  ejection  of  the  rear  occupant  is  complete.  Bouncing  from  the  inverted  position  the 
vehicle  completes  another  half  turn  and  impacts  the  ground  with  the  tires  again. 

The  Severity  Index,  plotted  in  Fig.  28,  indicates  a  very  high  probability  of  fatal  injuries  for  the  occupants 
under  the  conditions  simulated. 
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Figure  27.  Front  view  of  the  rollover  simulation  of  a  vehicle  with  three  occupants 


Figure  28.  Severity  Index  for  the  vehicle  occupants 

Notice  that  the  model  has  rigid  seats,  rigid  interior  trimming  for  the  dashboard,  side  and  floor  panels,  and 
that  the  ground  is  also  considered  to  be  rigid.  It  is  expected  that  the  head  accelerations  are  somehow  lower  if 
some  compliance  is  included  in  the  seats  and  side  panels  of  the  vehicle  interior. 

5.3.  SPORTS  VEHICLE  MULTIBODY  MODEL 

The  formulation  presented  here  is  applied  to  a  replica  of  the  original  Lancia  Stratos,  shown  in  Fig.  29,  in 
different  frontal  and  oblique  collision  scenarios.  The  multibody  model,  described  by  rigid  bodies  and  spring- 
damper  elements,  includes  the  suspension  elements,  steering  system  and  chassis.  The  front  crash-box,  modeled 
by  nonlinear  finite  elements,  is  also  included  [40]. 


Figure  29.  Prototype  of  the  sports  car 


The  multibody  model  of  the  vehicle  is  composed  of  16  rigid  bodies.  The  system  components  include  the 
front  double  A-arm  suspension  system,  the  rear  McPherson  suspension  system,  wheels  and  chassis  as  depicted 
by  Fig.  30.  To  model  the  tire  interaction  with  the  ground  an  analytical  tire  model  with  comprehensive  slip  is  used 


Figure  30.  Multibody  model  of  the  sports  vehicle 
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5.3.1.  Sports  Car  Crash-Box  Model 


The  sports  car  front  crash  box  is  depicted  in  Fig.  31.  For  the  purpose  of  the  frontal  and  oblique  impacts  at 
moderate  velocities,  the  model  for  the  chassis  is  considered  rigid  except  for  the  front  crash-box  that  is  flexible. 


Figure  3 1 .  Model  of  sports  car  chassis  with  a  nonlinear  flexible  front  crash-box 

The  complete  system  has  15  degrees  of  freedom  associated  with  the  rigid  bodies  and  186  nodal  degrees  of 
freedom.  This  model  is  valid  if  plastic  deformations  are  to  occur  in  the  parts  of  the  vehicle  modeled  as  flexible 
regions  and  no  significant  deformation  takes  place  in  the  passenger  compartment. 

5.3.2.  Vehicle  Frontal  And  Oblique  Impact  Simulations 

The  sports  vehicle  with  the  front  crash-box  is  analyzed  for  various  impact  scenarios,  represented  in  Fig.  32, 
where  the  angle  of  impact  and  the  topology  of  the  road  are  different.  For  the  crash  scenarios  the  contact  models 
are  applied  and  the  existence  of  friction  forces  is  considered.  The  simulations  are  carried  until  the  vehicle 
reaches  a  full  stop. 


(a)  (b)  (c)  (d)  (e) 


Figure  32.  Impact  with  a)  surface  perpendicular  to  vehicle  heading;  b)  10°  oblique  surface,  no  friction;  c)  20°  oblique  surface,  no  friction;  d) 
20°  oblique  surface,  friction;  e)  Same  as  (d)  but  the  vehicle  goes  over  a  10  cm  ramp. 

The  vehicle  motion  for  different  impact  scenarios  is  presented  in  Fig.  33.  For  oblique  contact  with  the 
obstacle  there  is  a  slight  rotation  of  the  vehicle  during  impact.  This  rotation  is  more  visible  in  the  case  of 
frictionless  impact.  At  the  simulated  impact  speed  the  influence  of  the  car  suspension  elements  over  the 
deformation  mechanism  is  minimal.  Flowever,  the  suspension  system  plays  an  important  role  on  the  variation  of 
the  relative  orientation  between  vehicle  and  obstacle  before  and  after  the  crash. 


(b) 


Figure  33.  Motion  of  the  vehicle  for  (a)  Frontal  impact;  (b)  20°  Oblique  impact  without  contact  friction 

The  efficiency  of  the  crash-box  to  dissipate  the  kinetic  energy  of  the  vehicle  decreases  with  the  increase  of 
the  angle  value  between  surface  normal  and  vehicle  heading.  It  is  observed  that  for  the  frontal  crash  the  front 
structure  dissipates  all  kinetic  energy.  However,  for  oblique  impacts  with  no  surface  friction,  only  part  of  that 
energy  is  absorbed  by  the  crash-box.  The  vehicle  motion  is  deflected,  and  would  continue  if  no  other  component 
of  the  car  entered  in  contact  with  the  surface.  In  Fig.  34  the  forces  developed  between  vehicle  and  surface  are 
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plotted. 


For  the  crash  scenarios  where  friction  is  modeled,  the  deflection  of  the  vehicle  motion  does  not  occur, 
enabling  the  structure  to  deform  with  a  crushing  mechanism  similar  to  that  of  the  frontal  impact.  Only  a  slight 
sideways  translation  of  the  vehicle  is  observed.  This  result  clearly  emphasizes  the  importance  of  a  correct  model 
for  the  friction  forces  developed  during  contact. 

6.  Conclusions 

Deformation  descriptions  can  be  included  in  multibody  system  components  for  application  in  contact  and 
impact  situations.  The  deformations  may  be  localized  in  a  small  region  of  the  body,  neighboring  the  point  of 
contact,  or  they  may  occur  in  parts  of  the  system  away  from  contact.  Therefore,  the  potential  system 
deformation  may  be  described  by  the  contact  model  used,  if  these  are  localized  at  the  contact  point,  or  they  may 
have  to  be  included  in  the  multibody  formulation.  Two  representations  of  the  system  deformations  have  been 
proposed  here. 

The  plastic  hinge  technique  can  be  used  when  the  deformation  mechanisms  are  well  known  beforehand. 
Therefore,  it  is  possible  to  model  the  structural  components  as  a  multibody  sub-system  having  the  kinematic 
joints  located  in  the  regions  where  the  plastic  hinges  are  expected.  The  second  model  reviewed  uses  nonlinear 
finite  elements  to  represent  the  distributed  deformations  of  the  flexible  body.  This  approach  has  the  advantage 
of  not  requiring  any  particular  knowledge  of  the  deformation  mechanisms  beforehand  but  it  is  computationally 
more  expensive. 

The  contact  models  used  may  also  represent  to  a  certain  degree  the  structural  deformations  in  the  bodies  in 
contact.  A  continuous  force  model  has  been  described  for  both  flexible  and  rigid  multibody  systems  impact 
while  a  contact  model  based  in  unilateral  constraints  has  been  proposed  for  flexible  multibody  systems.  It  was 
shown  that  in  the  case  of  flexible  multibody  contact  both  models  yield  similar  results,  provided  that  the 
equivalent  stiffness  used  for  the  continuous  force  model  is  based  in  the  Hertzian  elastic  contact  theory. 

Through  the  application  to  vehicles  and  biomechanical  impacts  in  diverse  scenarios  it  was  possible  to 
appreciate  the  range  of  application  of  the  different  methodologies  proposed  and  their  combination. 
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Abstract 

We  present  a  velocity-impulse  linear  complementarity  framework  for  time-stepping  in  multi¬ 
body  dynamics  with  contact  and  friction.  The  scheme  is  always  consistent  unlike  acceleration 
force  setups  which  may  fail  for  some  configurations.  We  demonstrate  that,  for  some  simple 
configurations,  the  solution  set  of  the  linear  complementarity  problem  is  not  convex,  for  ar¬ 
bitrarily  small  but  nonzero  friction  coefficients.  Nevertheless  we  show  that,  for  sufficiently 
small  but  nonzero  friction  coefficients,  a  fixed  point  iteration  that  solves  at  each  step  a  convex 
linear  complementarity  problem  will  retrieve  the  unique  velocity  solution  of  disassemblable 
configurations. 


1.  Introduction 

Recently,  time-stepping  methods  have  been  developed  in  an  impulse-velocity  framework 
that  avoid  the  inconsistencies  (Painleve  paradoxes)  that  may  appear  in  the  classical  ap¬ 
proach  [2,  3,  15,  14].  These  methods  can  be  modified  to  accommodate  the  most  common 
types  of  stiffness  [1].  Although  an  important  difficulty  was  overcome,  there  is  still  the  issue 
of  solving  efficiently  the  linear  complementarity  problem. 

We  show  that,  for  very  simple  configurations,  the  velocity-impulse  solution  set  can  be 
nonconvex  for  arbitrarily  small  but  nonzero  friction  coefficients,  which  is  almost  always  an 
indication  of  exponential  complexity  in  the  resolution  of  the  problem.  Nevertheless,  we 
show  that,  for  sufficiently  small  coefficients,  the  velocity  solution  is  unique  whenever  the 
frictionless  configuration  can  be  disassembled.  We  show  that,  for  small  friction  coefficients 
at  the  contacts,  the  unknown  velocity  is  a  fixed  point  of  a  certain  contraction  mapping.  To 
evaluate  the  mapping,  one  needs  to  solve  only  convex  linear  complementarity  subproblems 
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Computing,  U.S.  Department  of  Energy,  under  Contract  W-31-109-Eng-38. 
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(which  are  the  optimality  relations  for  some  convex  quadratic  program).  Therefore  the  fixed 
point  iteration  can  be  set  up  reasonably  efficiently. 

Several  other  approaches  exist  in  computational  contact  mechanics  that  have  a  fixed- 
point  iteration  flavor  where  convex  subproblems  are  used  to  compute  the  values  of  the 
contraction  mapping  [7,  12,  13].  These  approaches  evaluate  successively  the  normal  force 
keeping  the  tangential  force  fixed  and  then  the  tangential  force  keeping  the  normal  force 
fixed.  These  approaches  rely  fundamentally  on  the  assumption  that,  if  the  normal  force 
is  specified,  the  tangential  force  can  be  uniquely  computed.  In  the  simple  example  of  one 
rigid  rectangle  sitting  flat  and  at  rest  on  top  of  another  larger  rigid  rectangle  that  is  not 
true:  there  is  an  infinite  set  of  tangential  forces  that  satisfy  all  the  model  constraints. 

2.  The  linear  complementarity  problem  of  the  time-stepping  • 
scheme 

Our  approach  covers  several  types  of  constraints.  In  the  following  q  and  v  will  constitute 
the  position  and,  respectively,  velocity  vector  of  a  system  of  several  bodies.  Complemen¬ 
tarity  Notation  We  denote  by  a  >  0  J_  6  >  0  complementary  vectors  with  nonnegative 
entries  that  satisfy  aTb  —  0. 

2.1  Model  Constraints 

Joint  Constraints  Such  constraints  axe  described  by  equations  Q^\q)  =  0,  i  =  1, 2, . . .  ,  m. 
We  denote  by  t/M  ( q )  the  gradient  of  the  corresponding  function,  or  i/W  (g)  =  Vg0W(<?),  i  = 

1.2.. ..  ,  m.  The  impulse  exerted  by  a  joint  on  the  system  is  (q)  where  is  a  scalar 

related  to  the  Lagrange  multiplier  of  classical  constrained  dynamics  [10]. 
Noninterpenetration  Constraints.  The  noninterpenetration  constraints  are  &(J)(q)  > 
0,  j  =  1, 2, . . .  ,p,  where  the  generalized  distance  functions  (q)  can  be  assumed  to  be 
differentiable  in  most  cases  by  considering  appropriate  geometric  primitives  [8].  When  the 
contact  j  is  active,  =  0,  a  compressive  normal  impulse  >  0  acts  on  the  system. 

In  generalized  coordinates  the  impulse  becomes  where  rPP  =  Vg^^(q).  The  fact 

that  an  inactive  contact  cannot  exert  an  impulse  is  quantified  by  ^\q)  _L  <£>  =  0.  j  = 

1.2 .. ...p. 

Frictional  Constraints  are  expressed  via  a  discretization  of  the  friction  cone  [14,  2,  1]. 
For  a  contact  j,  we  take  a  collection  of  coplanar  vectors  dt(q),  i  =  1,2,...  , me  which 
span  the  plane  tangent  at  the  contact  (though  the  plane  may  cease  to  be  tangent  to  the 
the  contact  normal  when  mapped  in  generalized  coordinates,  [5]).  We  denote  by  D(q )  = 
[d\{q),  d,2(q),  ■  ■  ■  ,dmc(q)].  A  tangential  impulse  will  be  fildl(q),  where  Pi  >  0,  i  = 

1.2.. ..  ,  me-  If  we  denote  by  P  =  (Pi,  /%,  -  •  •  ,  Pmc )  j  the  total  tangential  impulse  becomes 
D(q)p.  The  friction  model,  which  ensures  maximum  dissipation  for  given  cn  and  velocity 
v,  as  well  as  that  the  total  contact  force  is  inside  the  discretized  cone,  is  [14,  2] 

D(q)Tv  +  Ae  >  0  JL  p  >  0,  fiCn  -  eTp  >  0  1  A  >  0.  (2.1) 

Here  e  =  (1, 1, . . .  ,  l)r  is  of  dimension  me,  and  /z  is  the  friction  parameter. 

Dynamical  data  of  the  simulation.  We  denote  by  M(q)  the,  symmetric,  positive  defi¬ 
nite,  mass  matrix  of  the  system  and  by  k(t,q,v )  the  external  force. 

Contact  indexing  convention.  All  quantities  described  in  this  section  associated  with 
contact  j  are  denoted  by  the  superscript  b-) . 
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Norm  convention.  When  we  use  a  vector  or  matrix  norm  whose  index  is  not  specified,  it 
is  the  2  norm. 


2.2  The  linear  complementarity  problem 

For  use  in  a  time-stepping  scheme,  we  linearize  the  constraints  to  obtain  (q)v  =  0 
for  joint  constraints  and  r^\q)T v  >  0  for  active  noninterpenetration  constraints.  The  set 
of  active  indices  is  denoted  by  A,  and  is  updated  at  every  step,  possibly  following  a  collision 
resolution  [2]. 

Let  h  be  time  step.  If,  at  some  time  t^\  the  system  is  at  position  qW  and  velocity 
then  we  choose  the  new  position  to  be  ?(i+1)  =  qW  +  hvV+1\  where  t/'+1)  is  the  solution 
of  the  following  mixed  linear  complementarity  problem  that  collects  all  the  constraints 
introduced  above  [2,  3] 


—v  —n  —D  0 
0  0  0  0 


n1  0  0 

DT  0  0 

0  0  p 


0  0 
0  E 
-Et  0 


-MdW  -  hfc(0 
0 
0 
0 
0 


Cn  p 

P  >0,  O  >0. 

A  J  L  C  J 


(2.3) 


Here  u •  =  cu  =  [&\  . . . ,  ,  fr  =  fc<WfnC«,  = 

[‘r  ,«  P  =  [PUl)T,0 . 0U>)T]T,  D  =  A  = 

[A(Ji),a02),...,a0-)],  ft  =  and  ^  _  dia£f(etf i),eU*)  ’e(i.)) 

are  the  lumped  LCP  data,  and  A  =  are  the  active  contact  constraints. 

The  vector  inequalities  in  (2.3)  are  to  be  understood  componentwise.  To  simplify  the 
presentation  we  have  eluded  the  dependence  of  the  geometrical  parameters  on  the  data  of 
the  simulation  Also  is  the  mass  matrix,  which  we  assume  to  be  positive  definite,  at 
time  (/)  and  represents  the  external  force  at  time  ( l ). 


3.  An  example  of  configuration  with  nonconvex  solution  set 

K  the  friction  coefficients  are  ft)  =  0,  j  €  A,  then  the  mixed  linear  complementarity 
problem  (2.2-2.3J  has  a  convex  solution  set  and  can  be  solved  in  a  time  that  is  polynomial 
with  respect  to  the  problem  size  [4],  An  important  question  is  whether  it  can  be  guaranteed 
that  the  mixed  linear  complementarity  problem  (2.2-2.3)  can  be  solved  efficiently,  preferably 
m  polynomial  time,  at  least  for  small  friction  coefficients. 

Consider,  however,  the  configuration  in  Figure  1,  where  a  block  of  mass  1  sits  on  a  table. 
Assume  that  the  friction  coefficient  is  p  and  that  the  initial  velocity  is  0.  The  mixed  linear 
complementarity  problem  (2.2-2.3)  can  then  be  written  such  that  both  the  contact  and  the 
friction  force  act  only  at  the  corners  of  the  body  [5], 

We  denote  by  the  superscripts  (1)  and  (2)  quantities  connected  to  the  left  and  right 
corners  of  the  body  with  the  table,  ^ ,  i  =  1,2,  j  =  1,2  the  tangent  impulses  acting  in 
direction  i  for  contact  (j).  j  =  1,2  are  the  normal  impulses,  g  is  the  gravitational 


36 


■< - 

beta^) 

beta^  betap) 

2  1 

c<!> 

n 

beta  ^ 

c(2) 

n 

Figure  1.  Example  of  a  nonconvex  solution  set. 


acceleration  and  h  is  the  time-step,  vx  and  vy  are  the  velocities  of  the  body.  Also 
j  =  1,2  are  the  multipliers  that  complete  the  friction  model  (2.1).  Here  fi  is  the  friction 
coefficient  at  both  ends  of  the  body. 

All  solutions  must  satisfy  vx  —  vy  =  0.  Two  solutions  of  (2. 2-2. 3)  are 

1  clX)  =  c£2)  -  /?i1}  =  =  (3®  =  =  0,  =  A(2)  =  1. 

2  <£>  =  ci2)  =  ^,  =  42)  =  0,  p[2)  =  41}  =  A^)  =  At2)  =  0. 

If  we  take  the  average  of  these  solutions,  we  obtain  ciP  =  =  4^,  =  0, 

Pi  ^  At1)  =  At2)  =  |.  It  can  be  immediately  verified  that  these  choices, 

together  with  vx  —  vy  —  0  do  not  satisfy  (2. 2-2. 3),  in  particular  the  complementarity 
constraint 


P{2)  >01  At2)  >  0. 

which  is  clearly  violated  for  our  choice  above  when  n>  0. 

Therefore,  even  for  simple  cases  and  the  smallest  nonzero  friction  coefficients,  the  solution 
set  of  (2.2-2. 3)  will  not  be  convex.  Therefore  the  matrix  of  this  linear  complementarity 
problem  cannot  be  P*,  which  is  the  largest  class  of  matrices  for  which  polynomial  time 
algorithms  are  known  [4],  This  raises  an  important  difficulty  in  the  path  of  efficiently 
finding  solutions  to  the  multibody  dynamics  problem  with  contact  and  friction,  when  a 
considerable  number  of  contacts  is  active,  even  for  the  smallest  friction  coefficients.  In  the 
next  section  we  will  construct  a  fixed-point  iteration  that  retrieves  the  velocity  solution  by 
solving  positive  semidefinite  subproblems. 

4.  A  convex  relaxation  of  (2. 2-2. 3) 

In  the  following  section,  we  will  approximate  the  mixed  linear  complementarity  problem 
(2. 2-2. 3)  by  the  following  mixed  linear  complementarity  problem 
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Here  F  is  a  nonnegative  vector  that  has  as  many  components  as  active  constraints  (elements 
in  A).  It  is  clear  that  the  matrix  of  the  linear  complementarity  problem,  which  we  denote 
by  M,  is  now  positive  semidefinite  since  xT  Mx  >  0,  Vs. 


4.1  Fixed  Point  Iteration  Algorithm 

Based  on  the  relaxation  (4.4-4.5)  we  define  the  following  fixed  point  iteration  algorithm. 

1  Set  r(0)  =  0,  k  =  0,  v*(0)  =  0. 

2  Solve  the  convex  mixed  linear  complementarity  problem  (4. 4-4.5)  for  T  =  T(k)  and 
find  the  new  velocity  v*(k  +  1)  =  v*(r(«)). 

3  Define  X(k  +  1),  a  component  of  the  solution  of  (4.4-4.5)  for  F  =  r(«) 

A^)‘(«  +  !)  =  _  max  ^  jcf  }V(/<  +  1)J  ,  j  <=  A.  (4.6) 

1—1,2,...  ,rn.£-. 

4  Define  T(k  +  1)  =  p,X(n  +  1)  (recall  from  the  discussion  following  the  definition  of  the 
mixed  linear  complementarity  problem  (2  2-2.3),  p  is  a  diagonal  matrix  whose  entries 
are  the  friction  coefficients  of  the  individual  contacts).  From  the  assumption  that  the 
tangential  force  description  is  symmetric  we  clearly  have  that  F(/t)  >  0,  Vk. 

5  Define  k  =  k  +  1  and  return  to  step  2. 

Our  convergence  result  is  based  on  a  regularity  assumption  of  the  constraint  geometry. 
We  assume  that  the  gradients  of  the  equality  constraints  l /’ho),  i  =  1  2  m  are  linearlv 
independent  and  that  there  exists  u*  ±  0  such  that  ’  ’  7 

nTti#  >  0,  vTu *  —  0. 

When  this  assumption  holds  the  configuration  can  be  disassembled  [6].  This  is  also  equiv- 
alent  to  the  fact  that  the  friction  cone  is  pointed  for  sufficiently  small  friction  coefficients. 

ms  regularity  assumption  allows  us  to  obtain  the  main  result  of  our  work.  The  proof  is 
included  in  the  extended  version  of  the  paper. 

Theorem  1  Under  the  constraint  regularity  assumption  above  there  exists  n°  >  0  such  that 
w  enever  ||/i||  <  p,  the  problem  (2.2-2. 3)  has  a  unique  velocity  solution  and  the  fixed-point 
algorithm  above  converges  linearly  to  it. 
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Abstract 

The  controlled  multibody  systems  are  under  the  consideration.  At  the  lecture  special  emphasis  is  put  on  the  study 
of  underactuated  and  overactuated  systems  having  different  type  of  actuators  (external  powered  drives, 
unpowered  spring-damper  like  drives,  etc.).  Several  questions  are  addressed  about  the  role  of  inherent  dynamics, 
and  how  much  multibody  system  should  be  governed  by  external  powered  drives  and  how  much  by  the  system’s 
inherent  dynamics.  The  lecture  consists  of  the  following  parts:  introduction  to  the  subject  in  question; 
mathematical  statement  of  the  optimal  control  problems  that  are  suitable  for  modelling  of  controlled  motion  and 
optimization  of  semi-passively  controlled  multibody  systems  with  different  degrees  of  actuation;  description  of 
the  methodology  and  the  numerical  algorithms  for  solution  of  control  and  optimization  problems  for  semi- 
passively  actuated  multibody  systems.  The  solutions  of  several  optimal  control  problems  for  different  kind  of 
semi-passively  actuated  multibody  systems  are  presented.  Namely,  the  energy-optimal  control  of  planar  semi- 
passively  controlled  three-link  manipulator  robot,  the  energy-optimal  control  of  closed-loop  chain  semi- 
passively  actuated  SCARA-like  robot;  optimization  of  the  hydraulic  and  pneumatic  drives  of  the  multibody 
system  modelled  the  human  locomotor  apparatus  with  above-knee  prostheses,  and  others.  Future  perspectives  in 
area  of  control  and  optimization  problems  of  the  semi-passively  actuated  multibody  systems  are  discussed. 

1.  Introduction 

Today  our  knowledge  in  mechanics,  control  engineering,  electronics  and  computer  sciences  is  actively  integrated 
into  a  new  interdisciplinary  science  —  mechatronics  [1],  One  of  the  primary  goals  of  mechatronics  is  to  gain  as 
many  advantages  as  possible  from  the  optimal  interaction  between  the  mechanical,  control,  electronic  and 
computer  subsystems.  This  requires  more  fundamental  research  on  a  number  of  topics  of  controlled  multibody 
systems,  e.g.  parameter  identification  and  optimal  design,  contact  and  impact  problems,  large  deformation 
problems,  control-structure  interaction,  etc.,  [2-3].  The  research  in  above  areas  can  help  to  improve  performance 
characteristics  of  modem  mechatronic  products. 

The  most  important  and  relevant  characteristics  of  interaction  between  inherent  dynamics  and  control  of 
any  mechanical  system  are  its  degree  and  type  of  actuation.  Most  technical  systems,  e.g.  industrial  robots,  have 
been  designed  based  on  the  commonsense  rule  of  minimum  complexity  of  the  structure.  The  industrial  robots 
have  usually  the  same  number  of  actuators  as  of  the  degrees  of  freedom  of  their  mechanical  subsystems,  i.e.  they 
belong  to  the  class  of  fullyactuated  mechanical  systems.  A  lot  of  research  has  already  been  done  in  area  of 
control  and  optimization  of  fullyactuated  robotic  systems  that  successfully  supported  industrial  robotics.  If 
multibody  system  (MBS)  has  less  actuators  than  joints  or  more  precisely  if  the  dimension  of  the  configuration 
space  exceeds  that  of  the  control  input  space,  the  system  is  called  underactuated.  Examples  of  underactuated 
MBS  are  a  car  with  n  trailers  having  spring-damper- like  joints,  manipulator  robots  with  failed  actuators,  free- 
flying  space  manipulators  without  jets  or  momentum  wheels,  manipulator  robots  with  flexible  links,  legged 
robots  with  passive  joints,  etc.  The  general  advantages  of  using  underactuated  mechanical  systems  reside  in  the 
fact  that  their  weight  is  lower,  and  they  consume  less  energy  than  their  fullyactuated  counterparts.  For  hyper- 
redundant  robots  or  multi-legged  mobile  robots,  where  large  kinematic  redundancy  is  available  for  dexterity  and 
specific  task  completion,  underactuation  allows  a  more  compact  design  and  simpler  control  schemes.  The 
analysis  of  dynamics  and  control  of  underactuated  MBS  is  significantly  more  complex  than  that  for  fullyactuated 
ones.  A  survey  of  papers  in  the  above  area  has  shown  that  the  dynamics  and  control  problems  of  underactuated 
mechanical  systems  have  actively  been  studied  for  the  last  decade  [4-7], 

The  next  generation  of  robots  must  be  autonomous  and  dexterous  [8],  Dexterity  implies  the  mechanical 
ability  to  carry  out  various  kinds  of  tasks  in  various  situations.  Robots  must  have  many  sensors  and  more 
actuators  than  degrees  of  freedom,  i.e.  being  the  controlled  mechanical  system  with  sensing  and  actuation 
redundancies.  To  carry  out  optimally  the  complex  tasks  in  various  situations  it  can  be  desirable  to  change  a 
number  of  actively  controlled  degrees  of  freedom  of  robotic  system.  It  can  easy  be  done,  for  instance,  by  locking 
or  unlocking  some  of  the  actuators  of  robot  during  its  performance  of  the  specific  subtask  of  a  given  complex 
task.  From  the  point  of  view  of  control  it  means  that  robot  can  be  considered  as  over,  -fully,  or  underactuated 

*)  Manuscript  representing  the  lecture  to  be  delivered  at  NATO  AS1  Virtual  Nonlinear  Multibody  Systems ,  Prague,  2002 
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mechanical  system  during  its  performance  of  the  complex  task.  Obviously,  the  type  of  actuators  used  can  also  be 
different  depending  on  the  task  of  robot  [9-14], 

The  analysis  of  the  literature  and  the  above-mentioned  fundamental  aspects  shows  the  importance  of 
studying  dynamics,  control  and  optimization  problems  of  MBS  with  different  degrees  of  actuation  and  the 
robotic  systems,  in  particular.  This  research  is  of  a  great  challenge. 

In  the  paper  a  controlled  MBS  of  rigid  bodies  is  under  study.  External  controlling  forces  and  moments 
can  be  applied  directly  to  arbitrary  points  in  the  system.  These  controlling  stimuli  are  generated  by  external 
(powered)  drives.  It  is  assumed  that  displacement  and  velocity  dependent  internal  controlling  forces  and  torques 
can  also  be  applied  to  the  system.  These  controlling  stimuli  are  generated  by  internal  (unpowered)  drives,  e.g. 
spring-damper  actuators  located  between  arbitraiy  points  and  described  by  linear  and  angular  stiffness  and 
damping  parameters.  MBS  including  both  external  (powered)  and  internal  (unpowered)  drives  we  shall  term  a 
semi-passively  actuated  MBS.  In  the  paper  we  tackle  optimization  problems  for  MBS  having  unpowered 
actuators.  The  reasons  of  this  study  are  as  follows.  To  incorporate  spring-damper  actuators  into  the  structure  of 
MBS  and  to  design  optimally  their  parameters  can  give  several  advantages,  e.g.  to  decrease  a  number  of  external 
drives  and,  as  a  consequence,  to  decrease  the  weight  of  moving  links  and  the  energy  consumption  of  the  system. 
It  can  give  great  advantages  to  use  different  passive  compliance  elements  to  control  some  degrees  of  freedom  of 
manipulator  robots  and  legged  mechanisms  for  their  performance  of  working  tasks  with  periodic  laws  of  motion 
[9-13].  We  study  a  fundamental  question  about  optimal  interaction  between  the  controlling  stimuli  generated  by 
the  external  drives  and  the  proportional-differential  internal  forces  described  by  linear  and  angular  stiffness  and 
damping  parameters.  A  range  of  questions  is  also  addressed  about  the  role  of  inherent  dynamics  in  controlled 
motion,  and  how  much  MBS  should  be  governed  by  the  external  drives  and  how  much  by  the  system's  inherent 
dynamics.  We  are  in  particular  investigating  semi-passively  actuated  manipulator  robots  and  bipedal  walking 
mechanisms  having  spring-damper  actuators. 

In  this  paper  we  outline  the  results  that  will  be  presented  during  the  lecture. 

2.  Statement  of  the  problem 

Consider  a  MBS  the  controlled  motion  of  which  can  be  described  by  the  following  equations: 
x*  =/(x,u,w(r,£)),  g(x,  w(/,£))  =  0,  te[0,T]  (1) 

Here  x=  (x,,x2,...,x„)  is  a  state  vector,  u  =  (ul,u2,...,um)  is  a  vector  of  controlling  stimuli  (forces, 
torques)  generated  by  the  external  (powered)  drives  of  the  MBS,  w  =  (wuw2,--.,wr)  is  a  vector  of  the 
controlling  stimuli  of  the  internal  (unpowered)  drives  of  the  MBS,  and  T  is  the  duration  of  the  controlled  motion 
of  MBS.  Vector  functions  /  and  g  are  determined  by  the  structures  of  the  MBS  and  unpowered  drives, 
respectively,  £  is  a  vector  of  design  parameters  of  the  unpowered  drives. 

Constraints  and  restrictions  are  imposed  on  the  state  vector  x(t),  the  controlling  stimuli  of  the  unpowered 
drives  w(t,£),  and  the  external  control  laws  u(t)  of  the  system.  These  restrictions  can  be  written  in  the  following 


way: 

{x(0}e  Q, 

te[0,T ] 

(2) 

/e[o,r] 

(3) 

te[0,T] 

(4) 

In  formulas  (2)  -  (4),  Q  and  U  are  given  domains  in  the  state  and  control  spaces  of  the  system, 
respectively;  IT  is  a  set  of  addmissible  controlling  stimuli  determined  by  the  structure  of  the  unpowered  drives. 

The  differential  equations  (1)  together  with  the  restrictions  (2)-(4)  are  called  the  mathematical  model  of 
the  semi-passively  actuated  MBS.  This  model  can  be  used  for  many  applications,  e.g.  to  solve  the  design 
problems  of  lower  limb  prostheses  and  to  study  control  strategies  for  the  stable  motion  of  bipedal  locomotion 
systems  with  compliance  elements  at  the  joints  [6,  10],  for  computer  simulation  of  the  energy-optimal  motion  of 
closed-loop  chain  manipulator  robots  with  unpowered  drives  [12],  etc. 

Assume  that  there  exists  a  non-empty  set  of  vector-functions  w(t,£),  /e[0,r]}  which  satisfy 

the  equations  (1)  and  the  constraints  (2)-(4).  The  following  optimal  control  problem  can  be  formulated. 

Problem  A.  Given  a  MBS  the  controlled  motion  of  which  is  described  by  equations  (1).  It  is  required  to 
determine  the  vector-function  of  unpowered  drives  w,(t ,£),  the  motion  of  the  system  x.(t)  and  the  external 
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controlling  stimuli  u.(l,x.,w.) which  alltogether  satisfy  the  equations  (1),  the  restrictions  (2)-(4),  and  which 
minimize  the  given  objective  functional  <!>[«]. 

As  a  result  of  the  solution  of  Problem  A  the  optimal  structure  of  MBS  having  both  powered  and 
unpowered  drives  is  designed.  The  external  controlling  stimuli  for  the  system  are  also  found  which  minimize  the 
given  objective  functional. 

One  of  the  primary  goals  for  the  incorporation  of  unpowered  drives  into  the  structure  of  MBS  is  an 
improvement  of  their  control  processes.  It  means  that  the  validity  of  the  following  inequality  is  expected: 
4,[w*(C*«,w.)]  <  <I>[ Uo* 0> *0* ) ]>  where  x0. (/),  «0.(r)are  the  optimal  motion  and  the  controlling  stimuli  of 
the  MBS  without  the  unpowered  drives  obtained  under  the  restrictions  (2),  (4).  In  this  sense  the  solution  of 
Problem  A  could  help  to  estimate  the  limiting  possibility  of  improvement  of  the  external  control  strategies  for 
MBS  due  to  incorporation  into  their  structure  different  unpowered  drives  determined  by  the  constraints  (3). 

3.  Methodology 


We  have  formulated  the  optimal  control  problem  for  the  scmi-passively  actuated  MBS.  The  key  feature  of  the 
proposed  mathematical  statement  of  the  problems  is  the  direct  utilization  of  the  differential  equations  describing 
the  inherent  dynamics  of  internal  unpowered  drives  together  with  all  other  constraints  that  are  imposed  on  the 
state  vector  and  the  controlling  stimuli  of  the  system.  It  leads  to  the  non-uniqueness  of  the  solution  of  the  direct 
and  inverse  dynamics  problems  and  makes  it  possible  to  design  optimal  unpowered  actuators  for  MBS. 

In  general  case  for  MBS  with  many  degrees-of-freedom  powerful  numerical  algorithms  are  needed  to 
solve  Problem  A.  Futhermore,  during  the  calculation  of  optimal  control  laws  for  MBS  it  is  necessary  to  design  at 
the  same  time  the  optimal  structure  of  the  unpowered  drives  taking  into  account  the  restriction  (3).  This  can 

significantly  increase  the  complexity  of  the  computation. 

The  numerical  method  has  been  developed  [6,  10,  12]  for  the  solution  of  Problem  A  for  MBS,  which 
model  semi-passively  actuated  manipulator  robots  and  bipedal  locomotion  systems  with  unpowered  drives  at 
their  joints.  The  method  is  based  on  a  special  procedure  to  convert  the  initial  optimal  control  problem  into  a 
standard  nonlinear  programming  problem.  This  is  made  by  an  approximation  of  the  independent  variable 
functions  using  a  combination  of  polynomial  and  Fourier  series  and  by  the  solution  of  semi-inverse  dynamics 
problem.  The  key  features  of  the  method  are  its  high  numerical  efficiency  and  the  possibility  to  satisfy  a  lot  of 
restrictions  imposed  on  the  phase  coordinates  of  the  system  automatically  and  accurately.  The  efficiency  of  the 
developed  method  has  been  illustrated  by  solution  of  several  problems,  e.g.  by  computer  simulations  of  the 
energy-optimal  motion  of  closed-loop  chain  semi-passively  actuated  manipulator  robot,  the  bipedal  walking 
robot,  by  the  solution  of  design  problems  of  the  energy-optimal  above-knee  prostheses  with  several  types  of 
unpowered  knee  mechanisms  [6,  1 0,  1 2] . 

4.  Optimal  Passive  Drives  for  Given  Motion  of  MBS 

Consider  a  MBS  having  n  degrees-of-freedom.  Let  the  equation  of  its  controlled  motion  be  as  follows: 

A(q)q  +  B(q,  q)  =  u(t),  t  e  [O,  f]  (5) 

Here  q  =  (<7,,<?2, is  a  vector  of  the  generelized  coordinates,  u  =  (ul,u2,...,um)  is  a  vector  of  the 
controlling  stimuli  (forces,  torques)  generated  by  powered  drives  of  the  MBS,  w  =  (^,w2,...,wj  isavectorof 

the  controlling  stimuli  of  the  internal  (unpowered)  drives  of  MBS,  A(q),  B(q,  q)  are  given  matrices. 

At  the  same  time,  assume  that  MBS  has  additional  passive  drives,  namely  non-linear  visco-elastic  spring- 
damper-hke  actuators  in  its  structure.  The  mathematical  model  of  the  semi-passively  actuated  MBS  can  be 
written  as  follows: 

Aq)q  +  B(q,q)  =  u(J)+w(q,q),  w(q,q)  + kf(q,q)  =  0,  /e  [0,7]  (6) 

where  the  function  f(q,q)  determines  the  inherent  dynamics  of  the  passive  drives  under  the  restriction  (3)  and  k 
is  a  “damper  coefficient”. 

To  estimate  the  quality  of  the  control  processes  the  following  objective  functional  is  exploied 

T 

*[«(')]  =  JM1* ,  m = («? 1  (o + ... + «i  (oyn  (7) 
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Let  {q 0  (/),  Uq  (t),  t  e  [0, 7’]}  be  any  pair  of  functions  that  satisfy  equation  (5). 

It  is  assumed  that  the  motion  {<?0(/),  7  e  [o,  7"]}  can  also  be  realised  by  the  considered  semi-passively  actuated 
MBS.  Using  the  equations  (6),  the  external  controlling  stimuli  that  need  for  the  motion  are  written  as  follows 

“k<>(0  =  «o(0  +  */(?o><?o)  >  where  u0(t)  =  A(q0)q0(t)  +  B(q0,q0)  (8) 

For  the  control  law  (8)  the  objective  functional  (7)  will  be  equal  to 

T 

<E>[«wo(/)]=  J|K(0  +  ^/k(0,?o(0]|2^=  <b[u0(t)]+ak2  +2bk  , 
o 

T  T 

a=  j\\f(q0,q0fdt,  b=  \{ua{t),f(qa,q0j)dt  ,  (u0(t),f(q0,q0))-(uolf  +...  +  u0nf„) 

0  o 

It  can  be  shown  that  the  function  $[«„<) (0]  has  a  global  minimum  with  respect  to  the  damper  coefficient  k.  The 
value  of  this  minimum  is  equal  to  <J>min  =<t>[ u0(t)]-b2  la  for  the  following  optimal  value  of  the  damper 
coefficient  k,  -  -b! a . 

The  above  mentioned  makes  it  possible  to  conclude  that  for  a  MBS  with  n  degrees-of-freedom  and  for 
any  admissible  motion  {<?0(0»  te  [o,E]}  the  energy-optimal  non-linear  visco-elastic  spring-damper-like 

actuators  are  determined  by  the  formulae  w„  (q0 ,  q0 )  +  k.f  (q0 ,  q0 )  =  0,  t  e  [0,  r] . 

As  follows  from  above  due  to  the  incorporation  of  the  optimal  spring-damper-like  actuators  into  the  MBS 
structure  the  decrease  in  energy  consumption  is  equal  to 

®[«0(0]-®min  =|j(wo(0,/(9o.?o))*j  '  J||/feo  •  %  )f  *  • 

This  value  depends  only  on  the  given  motion  fe0(/),  /  e  [0,  T ]}  and  the  function  f{q,q)  determining  the 
inherent  dynamics  of  the  passive  drives. 

Usually  some  restrictions  are  imposed  on  the  external  controlling  stimuli  u(t) .  In  this  case  the  function 
f(q,q)  can  not  be  choosen  arbitrarily.  Indeed,  let  us  assume  that  the  external  controlling  stimuli  u{t)  are 
restricted  by  the  constraint  ||w(/)|| <  wmax,f  e  [0, r]  with  given  positive  number  umx.  Then  the  function 
f(q,q)  must  satisfy  not  only  the  restriction  (3)  but  also  the  inequality 
\\u0(t)-bf(q0,q0)/a\\<uma,  te  [0,r]  ,  where  u0(t),  a  and  b  are  determined  by  the  expressions  (8)  and 

(10). 

5.  Optimization  of  Controlled  Motion  of  Semi-Passively  Actuated  Manipulator  Robots 

Here  we  present  several  results  of  optimization  of  controlled  motion  of  semi-passively  actuated  three-link 
manipulator  robot  (Figure  1)  and  closed-loop  chain  semi-passively  actuated  SCARA-like  robot  (Figure  2). 

5.1.  THREE-LINK  MANIPULATOR  ROBOTS 

In  the  Figure  1  the  sketch  of  semi-passive  actuated  three-link  manipulator  robot  is  shown.  The  robot  can  have 
powered  drives  U-,  and  unpowered  (passive)  drives  P,  (spring-damper-like  actuators)  located  at  the  joints.  The 
torques  of  the  unpowered  drives  are  modelled  by  formulae 

Pi  -  ~ki  0 Pi  ~  <Pm )  -  0  <Pi  «  =  !.2.3  ( 1 1 ) 

where  k-,  are  the  stiffness  coefficients,  ct  are  the  damping  coefficients,  (pi0k  are  the  no-load  angles  of  the  torsional 
spring. 

The  controlled  motion  of  the  considered  semi-passive  actuated  three-link  manipulator  robot  is  described 
by  equations  (6).  For  the  robot  in  question  several  variants  of  the  Problem  A  have  been  solved  by  using  the 


(9) 

(10) 
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developing  methodology.  The  functional  (7)  has  been  used  to  estimate  energy  consumption  of  the  controlled 
motion  of  the  robot.  The  set  of  pick-and-place  operations  of  the  robot  are  under  the  particular  study.  For 
comparison  in  the  Figure  3-4  the  polar  paths  of  the  end-effector  of  the  robot  are  depicted  that  correspond  to  the 
solution  of  energy-optimal  control  problems  obtained  for  fiillyactuated  robot  without  unpowered  drives  and  for 
underactuated  robot  with  powered  drive  located  at  the  joints  O  and  A  and  with  unpowered  spring-damper-like 
drive  located  at  joint  B,  respectively. 


Enaryy-OptimaJ  Control  of  tho  Robot  lor  lb*  Pick  and  PUe*  Operation 


Figure  3. 


Enoroy-OpUrruM  Control  of  tt>*  Robot  lor  tha  Oran  PSck  and  Ptao a  Operation 


Figure  4. 
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5.2.  SEMI-PASSIVELY  ACTUATED  SCARA-LIKE  ROBOT 


In  the  paper  the  optimal  control  problems  of  a  new  structure  of  manipulator  robot  (Figure  2)  is  under  study. 
Proposed  robotic  system  has  the  following  new  features  in  comparison  with  the  well-known  SCARA  robot.  In 
addition  to  powered  drives  it  comprises  several  unpowered  (passive)  spring-damper-like  drives.  An  additional 
link  has  also  been  incorporated  into  the  structure  that  gives  the  possibility  to  obtain  a  semi-passively  actuated 
closed-loop  chain  robot.  Emphasis  is  put  on  a  study  of  the  interaction  between  the  controlling  stimuli  of  the 
powered  drives  and  the  torques  exerted  by  the  unpowered  drives  needed  to  provide  the  optimal  motion  of  the 
robots  with  different  degrees  of  actuation. 

The  robot  depicted  in  Figure  2  comprises  four  links  that  are  modeled  by  the  rigid  bodies  OA,  AB,  OD  and 
EC.  There  are  one  degree-of-ffeedom  rotational  joints  at  the  points  O  and  A,  and  translational  joints  at  the  point 
B.  All  joints  are  considered  frictionless. 

It  is  assumed  that  the  robot’s  links  OA,  AB  and  OD  move  in  the  horizontal  plane  OXY  under  the  action 
of  the  torques  u\{t).  «2(0  and  w3(r)  applied  to  the  links  OA,  AB,  and  OD,  respectively.  Under  the  action  of  the 
force  F(t)  the  link  EC  moves  along  the  direction  of  the  axes  OZ.  The  controlling  stimuli  u,{t),  i  =  1,  2, 3  and  F(t) 
are  exerted  by  the  powered  drives  of  the  robot.  The  robotic  system  also  comprises  spring-damper  actuators  at 
joints  O  and  A.  The  torques  exerted  by  these  actuators  p\  ,  p2  and  p2  act  on  the  links  OA,  AB  and  OD, 
respectively.  They  will  be  treated  as  the  controlling  stimuli  of  unpowered  (passive)  drives  of  the  robot.  Using  (fa, 
and  z  as  the  generalized  coordinates  the  equations  of  motion  of  the  considered  system  can  be  derived  by  using 
the  Lagrange  formalism  [12].  Here  we  study  motions  of  the  robot  in  the  horizontal  plane  OXY  only.  The 
inherent  dynamics  of  the  passive  drives  of  the  robot  can  be  modeled  in  different  ways,  e.g.  by  the  differential 
constraints  (11).  The  equations  of  the  plane  motion  of  the  robot  can  be  written  as  follows: 

f\  ( <P; , <Pi , 4>i )  =  +  P\  +  “3  +  Pi >  h . <Pi . fa )  =  u2  +  P2  +  K4»i )(«3  +  Pi)  ( 1 2) 

The  functions //  and  f2  are  determined  by  means  of  the  Lagrange  operator  [12]. 

The  considered  robot  is  an  overactuated  mechanical  system.  This  makes  it  possible  to  optimize  the 
controlling  stimuli  of  powered  drives  for  an  arbitrary  given  motion  of  the  robot. 

Problem  A.  1.  Assume  that  an  arbitrary  motion  of  the  robot  and  control  torques  of  unpowered  drives  are 
given,  i.e.  the  functions  <pi (t), pi (/) are  specified.  It  is  required  to  find  the  control  stimuli  u  =  (ul,u2,ui) 

which  minimize  the  functional 
r 

E[u(l)]=  \{u*{t)  +  ul{t)  +  ul(t))dl  (13) 

o 

subject  to  the  differential  constraints  (12). 

It  can  be  shown  that  the  solution  of  Problem  A.l.  is 

«3(0  =  (gi  +bg2)l{2  +  b2),  u\{t)  =  gx  -m3*(0>  u2{t)  =  g2-bu\{t)  (14) 

Here  the  functions  g,  and  g2  have  the  expressions: 


Si  ~fi-Pi~P3>  (15) 

The  obtained  controlling  stimuli  (14)  provide  execution  of  an  arbitrary  given  motion  of  the  overactuated  robot 
with  minimal  energy  consumption  £*. 

The  simplest  way  to  reduce  the  overactuation  of  the  considered  robot  is  to  exclude  one  of  the  powered 
drives.  For  instance,  assuming  that 

«3(0  =  0,  /e[0,r]  (16) 

the  unique  solution  for  the  functions  u,(/),  u2(t)  can  be  obtained  from  the  equations  (12).  In  this  case  the 
functional  (13)  is 

T 

E°=  \(gh‘)  +  gl(‘)W  (17) 

o 
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where  the  function  g,(r),  g2(0  are  given  by  the  formulas  (15).  Comparing  the  value  E°  with  the  value  of  the 

functional  (13)  for  the  obtained  optimal  controlling  stimuli  u](t)  it  is  easy  to  show  the  validity  of  the  following 
expression 

T 

E°-E‘  =  j(gi(t)+bg2(t))2/(2  +  b2)di  (18) 

o 

The  formula  (18)  shows  that  the  energy  consumption  needed  to  execute  an  arbitrary  given  motion  by  the 
considered  overactuated  robot  with  obtained  optimal  controlling  stimuli  (14),  (15)  is  less  than  the  energy 
consumption  of  the  same  robot  but  without  powered  drive  acting  on  the  link  OD. 

During  the  lecture  other  results  of  optimization  of  motion  of  closed-loop  chain  semi-passively  actuated 
SCARA-like  robot  will  be  presented. 

6.  Optimization  of  Controlled  Motion  of  Semi-Passively  Actuated  Bipedal  Locomotion  Systems 

Here  we  will  demonstrate  the  application  of  methodology  of  optimization  of  semi-passively  actuated  MBS  to 
solve  the  design  problems  of  lower  limb  prostheses. 

There  is  an  important  difference  between  the  dynamics  of  an  intact  limb  and  a  prosthetic  limb  of  an 
amputee.  In  the  paper  the  mathematical  modeling  of  a  human  gait  of  an  amputee  with  the  above-knee  prosthesis 
is  considered  based  on  a  supposition  that  the  force  moments  at  the  knee  and  at  the  ankle  joints  of  the  prosthetic 
leg  are  passive  ones.  The  values  of  these  moments  depend  not  only  on  the  gait  pattern,  but  also  on  the  prosthesis 
construction. 

The  model  of  the  amputee  locomotor  system  (ALS)  with  above-knee  prosthesis  is  depicted  in  Figure  5.  It 
is  assumed  that  the  above-knee  prosthesis  comprises  the  linear-viscoelastic  ankle  mechanism  and  the  hydraulic 
or  the  pneumatic  knee  mechanism. 


G 


Figure  5. 

During  locomotion  of  ALS  with  the  above-knee  prosthesis  the  control  torques 
Pi(0  =  C(A  ~Y\  +xl2)+K(fil  ~Y\)  +  D  ,  (19) 

«i(0  =  (^2  —  E\)S  pd-i(d\  +  Iq  )i/2  sin(or,  —  /3l  +7j)l 

are  generated  at  the  ankle  and  at  the  knee  joints  of  the  prosthetic  leg,  respectively. 

Here  C,  K  are  the  torsion  spring  and  the  damping  coefficients  of  the  ankle  mechanism;  D  is  determined  by 
the  free  angle  of  the  spring  and  torsion  spring  coefficients;  P{,P2  are  the  chamber  pressures  of  the  hydraulic  or 
the  pneumatic  actuator  that  can  be  calculated  by  using  the  equations  of  dynamics  of  the  knee  mechanism  of  the 
prosthesis  [15],  Sp  is  the  cylinder  piston  cross-area. 
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/,  =  +  d\  + 1\  +  2d1  {d?  +  /a2 )1/2  cos(a,  -A  +/?))’/2,  *7  =  * tan(/0  / A ) , 


(20) 


</2  =  |*iCo|>  /0=|^o|- 

The  controlled  motions  of  ALS  with  above-knee  prosthesis  are  described  by  the  equations  (6)  and  the 

formulae  (19),  (20).  .  . 

The  design  problem  of  the  above-knee  prosthesis  can  be  formulated  as  the  optimal  control  problem  with 
parameters  ( Problem  A).  The  considered  semi-passively  actuated  MBS  that  models  ALS  has  the  state 

vectorj x,i,y,y,W,altauPtji,Yi.Yl>is*^>  the  vector  of  the  powered  drives  controIling 

stimuli  w(/)  =  {<7i,92,w2>  Pi}-  and  the  vector  of  the  constructive  parameters  of  the  unpowered  drives 
Cp  =  (C, K, D, dl,d2,l0,S p,SQ) .  The  following  functional 


Ep  =—^{^\qi(W-ai)\  +  \u2(a2-P2)\  +  \P7(p2-Y2)\)dt  (21) 

is  used  during  the  solution  of  Problem  A.  The  objective  functional  (21)  estimates  the  energy  expenditure  per  unit 
of  distance  traveling  of  ALS.  The  same  approach  as  described  in  paragraph  3  has  been  used  to  solve  the  problem 
of  design  energy-optimal  above-knee  prostheses.  Due  to  the  dynamic  constraints  (19)  the  procedure  of 
converting  the  Problem  A  into  the  standard  nonlinear  programming  problem  includes  the  solution  of  the  semi- 
inverse  dynamics  problems  for  the  mechanical  system  that  models  ALS  with  the  above-knee  prosthesis.  It 
sufficiently  increases  the  time  consumption  of  the  numerical  algorithm  for  designing  the  energy-optimal  above¬ 
knee  prosthesis.  The  Problem  A  has  been  solved  numerically  for  two  types  of  the  prostheses:  the  above-knee 
prosthesis  with  the  hydraulic  actuator  at  the  knee,  and  the  prosthesis  with  the  pneumatic  knee  mechanism.  Some 
kinematic  and  dynamic  characteristics  of  the  energy-optimal  motion  of  ALS  with  optimal  structure  of  the  above¬ 
knee  prosthesis  obtained  by  the  numerical  solution  of  the  Problem  A  for  the  gait  with  natural  cadence  are  shown 
in  Figures  6-9  (solid  thin  curves  correspond  to  the  prosthesis  with  the  hydraulic  actuator  at  the  knee,  dashed 
curves  -  to  the  prosthesis  with  the  pneumatic  knee  mechanism).  Knee  angle  ( «i  -  A )  and  hiP  anSle  ( a\  ~  V )  of 
the  prosthetic  leg  are  depicted  in  Figures  6-7,  respectively,  (in  degrees).  Hip  torque  of  the  prosthetic  leg, 
(9l(r)/M),  and  knee  torque  of  the  healthy  leg,  (u2(t)/M)  are  presented  in  Figure  8-9,  respectively,  (in 
Nm/kg).  For  the  comparison  purposes  in  Figures  6-9  the  domains  of  the  values  of  the  respective  kinematic  and 
dynamic  characteristics  obtained  by  the  biomechanical  experiments  for  a  human  normal  gait  [16,  17]  are 
depicted  by  heavy  solid  curves. 


Figure  6. 


Figure  7. 
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Figure  8.  Figure  9. 

The  obtained  kinematic  and  dynamic  characteristics  of  the  motion  of  ALS  with  optimal  above-knee 
prosthesis  structures  are  within  reasonable  proximity  to  the  respective  characteristics  of  a  human  normal  gait  [16, 
17],  The  analysis  of  a  number  of  numerical  simulations  shows  that  the  natural  cadence  of  ALS  gait  gives  a 
minimum  to  the  energy  expended  per  unit  of  distance  traveled  comparing  to  the  amount  of  energy  needed  for  the 
slow  or  fast  gaits  [10], 

7.  Conclusion 

We  have  formulated  the  optimal  control  problem  for  the  semi-passively  actuated  MBS  ( Problem  A).  The  key 
feature  of  the  proposed  mathematical  statement  of  the  problems  is  the  direct  utilization  of  the  differential 
equations  describing  the  inherent  dynamics  of  the  passive  actuators  (internal  unpowered  drives)  together  with  all 
other  constraints  that  are  imposed  on  the  state  vector  and  the  controlling  stimuli  of  the  system.  It  leads  to  the 
non-uniqueness  of  the  solution  of  the  direct  and  inverse  dynamics  problems  and  makes  it  possible  to  design 
optimal  passive  actuators  for  MBS. 

In  the  general  case  to  solve  Problem  A  for  MBS  with  many  degrees-of-freedom  powerful  numerical 
algorithms  are  needed.  Futhermore,  during  the  calculation  of  optimal  control  laws  for  MBS  it  is  necessary  to 
design  at  the  same  time  the  optimal  structure  of  the  passive  drives  taking  into  account  the  restriction  (3).  This 
can  significantly  increase  the  complexity  of  the  computation. 

Closed-form  solution  of  Problem  A  has  been  obtained  for  arbitrary  given  motion  of  MBS  having  n 
degrees-of-freedom  MBS  and  passive  drives.  The  analysis  of  the  obtained  solutions  shows  that  in  several  cases 
the  incorporation  of  passive  drives  into  the  structure  of  MBS  can  decrease  the  energy  consumption  needed  for 
the  given  motion  of  the  system. 

The  numerical  method  has  been  developed  for  the  solution  of  Problem  A  for  MBS,  which  model  several 
types  of  semi-passively  actuated  robotic  and  biorobotic  systems.  Efficiency  of  the  proposed  method  is  illustrated 
by  computer  simulations  of  the  energy-optimal  motion  of  closed-loop  semi-passively  controlled  manipulator 
robot,  the  bipedal  walking  robot,  the  solution  of  design  problems  of  the  energy-optimal  above-knee  prostheses 
with  several  types  of  passively  controlled  knee  mechanisms,  etc.  Analysis  of  the  numerical  results  obtained  has 
shown  that  during  the  optimal  motion  of  the  considered  MBS  there  is  a  strong  interaction  between  the  gravity 
force,  the  external  control  torque  exerted  by  the  actively  controlled  drives  and  the  internal  torque  exerted  by  the 
passive  linear  spring-damper  actuators.  Moreover,  the  incorporation  of  the  optimal  passive  linear  spring-damper 
actuators  into  the  structure  of  the  closed-loop  robot  leads  to  a  significant  reduction  of  the  energy  consumption  of 
the  robot  for  cyclic  pick  and  place  operations  [12,  18].  The  kinematic,  dynamic,  and  energetic  characteristics  of 
controlled  motion  of  MBS  that  model  human  locomotor  system  with  above-knee  prosthesis  are  strongly  sensitive 
to  the  essential  parameters  of  the  passive  actuators  of  the  prosthesis.  For  a  given  individual  and  cadence  of  a  gait 
there  exist  optimal  values  of  the  spring  and  damper  parameters  of  the  prosthesis’s  ankle  and  knee  mechanisms. 
These  parameters  give  minimum  energy  expended  per  unit  of  distance  travelled  [10], 

Results  obtained  can  help  to  design  simpler  control  systems  of  manipulator  robots  and  autonomous 

mechanisms  having  less  weight  and  energy  consumption.  They  will  also  be  use  to  design  energy  efficient 
passively  controlled  mechanisms  of  the  lower  limb  prostheses. 
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1.  Introduction 

The  purpose  of  this  lecture  is  to  associate  multibody  dynamics  procedures  with  a  geomet¬ 
rical  picture  involving  the  concepts  of  configuration  manifolds,  linear  vector  spaces,  and  pro¬ 
jection  techniques.  An  unconstrained  system  is  assigned  a  free  configuration  manifold,  and  is 
regarded  as  a  generalized  particle  on  the  manifold.  The  system  dynamics  is  then  considered  in 
the  local  tangent  space  to  the  manifold  at  the  system  representation  point.  Imposed  constraints 
on  the  system,  the  tangent  space  splits  into  the  velocity  restricted  and  the  velocity  admissible 
subspaces,  and  the  configuration  confines  to  the  holonomic  constraint  manifold.  Following 
these  geometrical  concepts,  a  uniform  treatment  of  both  holonomic  and  nonholonomic  sys¬ 
tems  can  be  demonstrated  [3,4,10,12,13],  which  gives  an  intuitive  geometrical  insight  into  the 
problems  solved,  and  directly  appeals  to  the  geometry  of  constrained  particle  motion  known 
from  Newtonian  dynamics.  While  exploiting  the  differential  geometry  formalism,  the  paper  is 
written  in  standard  matrix  notation,  well  suited  for  computer  implementations. 

The  projection  method  leads  to  compact  schemes  for  obtaining  different  types  of  equa¬ 
tions  of  motion  and  for  the  determination  of  constraint  reactions  [3,4].  Uniform  projective 
formulations  and  geometrical  interpretations  of  many  classical  methods  of  multibody  dynam¬ 
ics  can  also  be  demonstrated  [4,6,12],  The  other  useful  implementations  are  schemes  for 
elimination  of  constraint  violations  [5,17],  improvements  in  the  variable  partitioning  method 
[8,16]  as  well  as  some  novel  multibody  codes  such  as  augmented  joint  coordinate  method  [7] 
and  an  orthonormalization  method  [2], 

2.  Unconstrained  system  dynamics 

Consider  an  n-degree-of-freedom  autonomous  system  defined  in  generalized  coordinates 
P  =  [Pi  •••  P„f  and  velocities  v  =  [v,  ...  vjr  (generalized  or  quasi- velocities),  which  can 
be  either  a  collection  of  unconstrained  rigid  bodies  or  a  Lagrangian  system  defined  in  inde¬ 
pendent  variables.  The  generic  matrix  form  of  the  initial  governing  equations  is  [3,4,14,15]: 

p  =  A(p)v  (1) 

M(p)v  +  d(p,v)  =  f(p,v,0  (2) 

where  A  is  the  n x  n  transformation  matrix,  M  is  the  nxn  symmetric  and  positive  definite 
generalized  mass  matrix,  d  =  [<7,  ...  dn]T  represents  the  centrifugal,  Coriolis,  and  gyroscopic 

dynamic  terms,  f  =  [/,  ...  fnf  are  the  applied  forces  related  to  v,  and  t  is  the  time. 

The  system  can  be  viewed  as  a  point  on  the  ^-dimensional  configuration  manifold  !K 
of  the  system.  At  each  position  p  e  !N~  ,  an  n-dimcnsional  tangent  space  to  the  manifold  can 
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Fig.  1.  The  CK  and  T.  ”  spaces. 


then  be  defined,  whose  positive-definite  quadratic 
form  is  expressed  by  the  system  kinetic  energy 
2T  -  vTMv.  So  endowed  with  the  metric,  N 
becomes  a  Riemannian  manifold  [3,4,10,12,13], 
and  the  said  local  tangent  space  at  p  e  JVf  is  an 
Euclidean  (linear  vector)  space  T.  n  (Fig.  1).  The 
generalized  mass  matrix  M  is  thus  the  metric  ten¬ 
sor  matrix  of  a  basis  referred  to  v,  and  the  dynamic 
equation  (2)  can  be  viewed  as  a  matrix  representa¬ 
tion  of  vector  formula  b  =  /  ,  where  b  =  M  v  +  d 
and  f  are  the  generalized  dynamic  and  applied 
forces,  respectively.  According  to  the  geometrical 


interpretation,  the  kinetic  energy  T  defined  above  can  be  seen  as  doubled  dot  product  of  the 
velocity  vector  v  of  the  system,  2T  =  v  °  v  .  Seemingly,  the  Appell’s  function  can  be  defined 
as  2S  =  bob  =brMb  =  (v  +  M"'d)rM  (v  +  M-1d)  . 


By  changing  the  velocity  components  from  v  to  v' ,  a  new  basis  of  fF  n  is  introduced, 
and  the  transformation  formula  is  v  =  Bv',  where  B  is  an  nxn  transformation  matrix  (for 


v'  =  p ,  B  =  A1  as  defined  in  (1)).  By  premultiplying  (2)  with  BT ,  the  dynamic  equations  are 
projected  into  the  new  basis  [3,4],  and  by  using  v  =  B  v'  and  v  =  B  v'  +  B  v'  they  can  then  be 


expressed  in  the  new  velocity  components, 


Br[M(Bv  +Bv')  +  d  =  f]  o  M'(p)v'  +  d'(p,v')  =  f'(P>v',0  (3) 

where  M'  =  BrMB,  d' =  Br(MBv'  +  d)  and  f'  =  Brf  have  the  same  meaning  as  in  (2).  This 
geometrically  grounded  projection  technique  constitutes  a  way  for  transformation  of  the  gov¬ 
erning  equations  between  different  sets  of  coordinates  and  velocity  components.  The  method 
can  be  extended/generalized  for  constrained  systems  as  well. 


3.  Geometry  of  constrained  system  dynamics 

Let  the  system  described  in  (1)  and  (2)  be  subjected  to  mh  holonomic  and  mnh  non- 
holonomic  constraints,  m  —  mh  +  mnh ,  all  scleronomic  for  simplicity  (for  rheonomic  con¬ 
straints  the  reader  is  referred  to  e.g.  [3,4]).  The  constraint  equations,  given  implicitly,  are: 

f  <D(p)=0  (4a) 

1  C„A(p)  v  =  0  (4b) 

The  holonomic  constraints  (4a)  define  a  F-dimensional  submanifold  3C  in  f  ,  k  =  n-mh, 
and  the  constrained  system  configuration  is  confined  to  3C  on  which  k  independent  curvilin¬ 
ear  coordinates  q  =  [qx  ...  qk]T  can  be  defined.  By  differentiating  with  respect  to  time  the 
holonomic  constraints  one  obtains  O  =  CA(p)v  =  0,  where  Ch  =  (3<X>/3p) A .  The  uniform 
constraint  equations  at  the  velocity  and  acceleration  levels  are  then 

=  C(p)v  =  0  (5) 

*  =  C(p)v-$(p,v)  =  0  (6) 

where  C  =  [C[  CTnh ]r  is  the  mxn  constraint  matrix,  and  £  =  -Cv  is  the  /^-vector  of  con¬ 
straint  induced  accelerations  (see  Figure  2  for  the  geometrical  interpretation). 

The  m  constraint  vectors,  represented  in  C  as  rows,  span  an  m-dimensional  constrained 
subspace  Cm  in  I”.  According  to  (5)  the  projection  of  the  system  velocity  v  into  C  m 
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vanishes  (Fig.  2a),  i.e.  v  is  sunk  in  the  unconstrained  subspace  29 r ,  which  complements 
Cm  in  In,  29ruC  m  ='En  and  29  r  r\Cm  =  0 .  For  the  considered  case  of  systems  with 
scleronomic  constraints,  C  m  and  29  r  are  then  velocity  restricted  and  velocity  admissible 
subspaces,  respectively.  The  subspace  29 r  can  be  defined  by  r  =  n-m  vectors  represented 
as  columns  of  an  nxr  matrix  D  which  satisfies  the  condition 

CD  =  0  <=>  DrCr  =0  (7) 

i.e.  D  is  an  orthogonal  complement  matrix  to  the  constraint  matrix  C  [3,4,12,15]. 


Fig.  2.  The  geometry  of  constrained  system  dynamics. 


The  reactions  of  ideal  constraints  are  by  assumption  collinear  with  the  constraint  vectors, 
and  are  represented  in  C  m  by  m  unknown  Lagrange  multipliers  X  =  [X,  ...  Xmf  .  The  repre¬ 
sentation  of  the  generalized  constraint  reaction  force  r  in  T  n  is  r  =  -CrX  [3,4,10,14,15], 
and  the  dynamic  equations  of  the  constrained  system  are 


M(p)  v  +  d(p,  v)  -  f (p,  v,/)  -  Cr(p)  X  (8) 

often  referred  to  as  Lagrange’s  equations  of  type  one.  The  vector  form  of  (8)  is  b  =f  +  r 
(Fig.  2b).  By  assuming  that  the  constraints  (4)  express  the  prohibited  relative  transla¬ 
tions/rotations  and  the  vanishing  relative  translational/rotational  velocities  in  the  joints,  the 
components  of  X  are  respective  physical  forces/torques. 

The  governing  equations  of  the  constrained  system  are  the  following  2 n  +  m  differential- 
algebraic  equations  (DAEs)  in  2 n  differential  variables  p  and  v,  and  m  algebraic  variables  X 

P  =  Av  p  =  A(p)  v  (9a) 


"m  cr 

V 

f-d' 

<=> 

V 

c  0 

X 

— 

.  %  . 

H(p) 

X_ 

h(p,v,t) 


(9b) 


and  the  initial  values  of  the  state  variables  must  satisfy  the  lower-order  constraint  equations 
(4a)  and  (5),  <P(p0)  =  0  and  ^(Po,  v0)  =  0 .  Since  the  leading  matrix  H  in  (9b)  is  invertible  if 
only  det(CM~'Cr)*0  [4],  standard  ODE  (ordinary  differential  equation)  methods  can  be 
used  to  solve  DAEs  (9)  for  p(t)  and  v(t) ,  and  simultaneously  X(t)  can  be  determined  using 
the  current  state  variables. 


4.  Constraint-referred  projection  formulation 

The  formula  (3)  describes  a  projection  of  the  dynamic  equations  (2)  from  a  basis  referred 
to  v  into  a  basis  referred  to  v' .  In  the  case  of  a  constrained  system  a  similar  projection  of  the 
dynamic  constraint  reaction-affected  equations  (8)  can  be  performed  with  respect  to  the  con- 
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strained  and  unconstrained  directions,  which  is  achieved  by  premultiplying  (8)  with 
[Dr  (CM~‘)r]r.  The  premultiplication  stands  for  the  projection  of  (8)  from  T.  n  (basis  re¬ 
ferred  to  v)  into  D  r  and  C  m ,  respectively,  and  yields: 

/  .  ,  *  r  \  =>  DrM v  +  Drd  =  Drf  (10a) 

(Mv+d  =  f-C^j 

v  '  =>  Cv  +  CM'd  =  CMf  -  CM'  CTX  (10b) 

The  geometric  interpretation  of  (10a)  and  (10b)  is  bd  =  fd  and  bc  =  fc+r  ,  respectively  (Fig. 
2b).  Using  the  tangential  projection  (10a),  2 n  ODEs  in  p  and  v  can  be  defined 


Dr 

CM'1 


p  =  A  v 


DrM 

v  — 

Dr(f-d) 

C 

V  — 

% 

P  -  A(p)  v 

<=> 

S(p)v  =  s(p,v,0 


(11a) 

(lib) 


The  orthogonal  projection  provides  then  an  algebraic  equation  for  the  determination  of  X 


X(p,v,0  =  (CM"lCr)"1[CM“1(f  -d)-^]  (12) 

The  dependent  variable  formulations  (9)  and  (11)  involve  the  second-order  differen¬ 
tial  constraint  equations  (6).  Thus,  the  exact  realization  of  only  these  constraint  equations 
is  assured  by  assumption.  The  lower-order  constraint  equations  (4a)  and  (5)  may  be  vio¬ 
lated  by  the  numerical  solutions  p(f)  and  v(/)  burdened  with  the  numerical  error  of  inte¬ 
gration,  <D  =  O(p)^0  and  T  =  T(p,  v)  ^  0  .  The  situation  differs  when  independent  state 
variables  are  used.  Most  of  the  independent  variable  formulations  can  conveniently  be  inter¬ 
preted  geometrically  and  assisted  with  the  projection  technique. 


5.  Geometrical/projective  interpretations  of  some  relevant  independent 
variable  formulations 

5.1,  Joint  coordinate  formulation  for  open-loop  holonomic  systems 

Let  us  assume  for  a  while  that  the  system  described  in  (1)  and  (2)  is  an  open-loop  (tree 
structure)  holonomic  system,  and  p  and  v  are  the  absolute  variables  that  describe  the  system 
position  and  velocity  with  respect  to  a  global  non-moving  reference  system.  The  constraints 
on  the  bodies  due  to  the  kinematical  joints  are  then  all  holonomic,  m  =  mh  and  mnh  =  0  in  (4). 
By  choosing  k  —  n-mh  independent  coordinates  q  =  [q}  ...  qk]T  to  describe  the  relative 
configurations  of  the  adjacent  bodies,  the  holonomic  constraint  equations,  given  implicitly  in 
(4a)  by  <D(p)  =  0 ,  can  also  be  expressed  explicitly  as 

p  =  g(q)  (13) 

and  by  assumption  the  holonomic  constraints  are  satisfied  identically  when  substituting  (13), 
d>(g(q))s  0 .  By  differentiating  (13)  with  respect  to  time  one  receives: 

v  =  D(q)q  (14) 

v  =  D(q)q  +  y(q,q)  (15) 

where  D  =  A"'(5g/3q)  and  y  =  Dq  are  of  dimensions  nxk  and  «xl,  respectively.  From 
substitution  of  (14)  and  (15)  into  (5)  and  (6)  it  follows  that  D  defined  above  satisfies  the  con¬ 
ditions  (7),  i.e.  it  is  an  orthogonal  complement  matrix  to  C  (now  C  =  Ch ),  and  then  Cy  =  t, . 

By  applying  the  explicit  forms  (13)  -  (15)  of  holonomic  constraints  to  the  projective 
scheme  described  in  Section  4,  from  the  tangential  projection  (10a)  one  obtains 
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DrM  (D  q  +  y)  +  Drd  =  Drf  o  M(q)q  +  d(q,q)  =  f(q,q,r)  (16) 

where  M=DrMD  is  the  kxk  generalized  mass  matrix,  d=Dr(My  +  d)  is  the  k  vector 
that  includes  generalized  centrifugal,  Coriolis  and  gyroscopic  terms,  and  f  =  Drf  is  the  A:  vec¬ 
tor  of  generalized  applied  forces,  all  related  to  q.  The  same  result  can  be  obtained  by  using 
different  methods,  see  e.g.  [4,9-15].  The  formula  (12)  for  determination  of  constraint  reac¬ 
tions  can  then  be  expressed  symbolically  as  X(q,q,0  or  reformulated  (Cy  =  % )  to 

Mq,q,0  =  (CM-1Cr)-'C[M-'(f-d)-y]  (17) 

The  scheme  as  above  can  also  be  treated  as  a  general  code  for  holonomic  systems  for 
transforming  the  dynamic  equations  formulated  in  dependent  variables  p  and  v  into  a  smaller 
set  of  equations  in  independent  coordinates  q.  However,  the  explicit  form  (13)  of  constraint 
equations  at  position  level  is  not  always  attainable  in  practice  (e.g.  for  closed-loop  systems). 

5.2.  Velocity  partitioning  formulation 

The  approach  is  usually  referenced  to  as  coordinate  partitioning  method  [16].  It  is  based 
on  formulating  the  explicit  constraint  equations  directly  at  the  velocity  and  acceleration  lev¬ 
els,  in  the  form  similar  to  (14)  and  (15).  In  a  general  sense  of  formulation  of  this  paper  it  is 
thus  rather  a  velocity  partitioning  method  [4], 

If  rank(C)  =  m  =  max ,  the  implicit-form  constraint  equations  (14)  and  (15)  can  always 
be  resolved  for  some  m  dependent  velocities/accelerations  w/w  in  terms  of  the  remaining  r 
independent  ones  u/u  The  partition  can  be  set  symbolically  as  v  =  [ur  wr]r ,  which  yields 
appropriate  factorization  of  the  constraint  matrix  C  =  [U  W],  where  U  and  W  are  the  mxr 
and  mxm  matrices,  respectively,  and  det(W)?iO  is  assumed.  By  applying  the  partition  to 
(14)  and  (15),  the  explicit  forms  of  the  velocity  and  acceleration  constraints  can  be  obtained: 

Cv  =  Uu  +  Ww  =  0  =>  v=_^  uhD(p)u  (18) 

Cv  +  S  =  Uu  +  Ww  +  ^  =  0  — ^  v=  u+  =  D(q)u  +  y(p,u)  (19) 

where  I  and  0  are  the  identity  and  null  matrices  of  dimensions  rxr  and  rx  1 ,  respectively.  It 
is  easy  to  check  that  the  nxr  matrix  D  is  an  orthogonal  complement  matrix  to  C,  DTCr  =  0 
The  relations  (18)  and  (19)  stand  thus  for  the  explicit  forms  of  the  constraints  at  the  velocity 
and  acceleration  levels,  and  correspond  to  (14)  and  (15).  In  order  to  avoid  possible  singulari¬ 
ties  when  det(W)-»0,  variant  formulations  for  different  coordinate  partitions  can  be  pre¬ 
pared  in  advance  to  change  between  them  when  necessary.  A  projective  criterion  for  best  (op¬ 
timal)  coordinate  partitioning  was  proposed  in  [8], 

With  the  use  of  (18)  and  (19)  and  the  projection  technique,  the  governing  equations  of  a 
constrained  system  can  be  transformed  to  n  +  r  ODEs  whose  symbolic  form  is: 

p  =  A(p)u  (20a) 

M(p)u  +  d(p,u)  =  f(p,u,r)  (20b) 

where  A  =  A  D ,  and  M  ,  d  and  f  are  as  defined  in  (16).  The  constraint  reactions  can  then  be 
obtained  from  either  (12)  or  (17),  which  can  both  be  represented  symbolically  as  X(p,u,t). 
The  velocity  partitioning  method  provides  one  with  a  general  and  useful  code  for  ODE  formu¬ 
lations  of  closed-loop  holonomic  systems  and  nonholonomic  systems  [4,10,13], 
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5.3.  The  minimal-form  formulation  for  closed-loop  systems 


Fig.  3.  Treatment  of  closed-loop  systems. 

A  multibody'  system  may  contain  one  ore  more  closed  kinematic  loops.  There  are  two 
basic  treatments  of  such  systems  (Fig.  3):  in  absolute  coordinates  p,  when  all  the  joints  in  the 
system  are  “opened”,  and  in  joint  coordinates  q  of  an  equivalent  open-loop  system  obtained 
after  cutting  each  closed  loop  at  one  of  the  kinematic  joints.  Both  p  and  q  are  dependent.  In 
each  case  the  arising  initial  governing  equations  are  then  DAEs,  and  can  afterwards  be  trans¬ 
formed  to  ODEs  by  using  the  coordinate  partitioning  method. 

The  DAE  and  ODE  formulations  in  p  have  already  been  described  and  are,  respectively, 
2 n  +  m  DAEs  (9)  and  n  +  r  ODEs  (20).  The  formulations  in  q  require  first  to  formulate  the 
dynamic  equations  (16)  for  the  equivalent  open-loop  system,  M(q)q  +  d(q,q)  =  f(q,q,0  • 
Imposed  the  remaining  l  =  m-r  closing  constraints  on  the  system,  O(q)  =  0 ,  the  following 
2 k  +  l  DAEs  in  q,  q  =  v  and  X  arise,  which  correspond  to  (9): 

q  =  v  q  =  v  (21a) 

C"  H(q)  I  =h(q,v,0  (21b) 

Ai 

where  C  =  d$>/dq  is  of  dimension  Ixk,  \  =  -C q ,  and  X  =  [ X,  X,  ]r  are  the  closing  con¬ 
straint  reactions.  The  DAEs  can  then  be  solved  for  q(t) ,  q(i)  and  X(f) .  _ 

Using  the  coordinate  partitioning  method  described  in  Section  5.2,  used  for  <h(q)  =  0 
and  q  =  [ur  wr]r ,  to  produce  q  =  D(q)u  and  q  =  D(q)u  +  y(<1j u)  as  described  in  (18)  and 
(19),  k  +  r  ODEs  in  q  and  u  can  be  obtained, 

q  =  D(q)u  (22a) 

M(q)u  + d(q,u)  =  f(q,u,t)  (22b) 

where  M  =  DrMD  ,  d  =  Dr (M y  +  d) ,  and  f  =  Drf  The  above  ODEs  can  be  considered  as 
the  minimal-form  formulation  for  closed-loop  systems. 
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5.4.  Treatment  of  nonholonomic  systems 

In  Section  3  a  uniform  treatment  of  holonomic  and  nonholonomic  systems,  respectively 
mnh  =  0  or  mnh  >  0 ,  is  provided  using  dependent  (possible  absolute)  variables  p  and  v.  Using 
the  projection  method,  the  initial  DAEs  (9)  can  then  be  transformed  to  ODEs  (20),  and  the 
transformation  is  based  on  the  relations  between  the  dependent  and  independent  velocities  and 
accelerations,  v  =  D(p)u  and  v  =  D(p)u  +  y(p,u).  In  general,  these  explicit  forms  of  con¬ 
straint  equations,  given  implicitly  in  (5)  and  (6),  can  be  determined  by  any  method  -  by  guess, 
inspection  or,  more  usual,  numerically  [14,15],  and  the  components  of  u  may  be  either  gener¬ 
alized  velocities  or  quasi-velocities  [3,4,10],  One  effective  techniques  of  the  latter  type  is  the 
velocity  partitioning  method  described  in  Section  5.2,  and  another  example  can  be  a  code 
based  on  Gram-Schmidt  orthogonalization  scheme  described  in  [2], 

In  DAEs  (9)  and  ODEs  (20)  the  holonomic  and  nonholonomic  constraints  (4)  are  treated 
in  a  unified  way,  and  the  dependent  coordinates  p  are  used.  The  other  possibility  is  first  to 
“eliminate”  the  holonomic  constraints  (4a)  and  obtain  the  dynamic  equations  (16)  in  inde¬ 
pendent  coordinates  q,  followed  the  scheme  provided  in  Section  5.1.  The  system  described 
with  these  equations  will  then  be  subjected  to  only  nonholonomic  constraints  (4b),  expressed 
in  the  new  variables  by  Cnh(q)  q  =  0 .  The  followed  governing  DAEs  are  then  as  in  (21),  and 
further  application  of  the  projection  method  (and  possibly  the  velocity  partition  scheme)  will 
lead  to  the  minimal-form  ODEs  (22)  in  the  independent  variables  q  and  u. 


5.5.  Gibbs’-Appell’s  equations 


The  Gibbs ’-AppelPs  method  provides  one  with  another  general  approach  to  holonomic 
and  nonholonomic  systems  [4,9],  According  to  the  geometrical  interpretation  of  Section  2,  the 
Appell’s  function,  after  using  v  =  Du  and  v  =  Du  +  y ,  can  equivalently  be  written  as 


2S  =  (v  +  M~‘d)rM  (v  +  M~'d)  =  (D u  +  y  +  MT'd)rM  (Du  +  y  +  M_1d) 
Applying  S  to  Gibbs’-AppelPs  equations  [9],  which  expressed  respectively  in  v  and  u  are: 


as 


=  { 


and 


as 

<9u  j 


=  f 


where  f  -  Drf ,  and  (dS/du)  =  D T(dS/dv) ,  one  receives  directly 


(23) 

(24) 


Mv  +  d  =  f  and  DrM(Du  +  Y  +  M~‘d)  =  Drf  (25) 

which  are  equivalent  to  (2)  and  (20),  respectively.  The  matrix  setting  of  Gibbs’-Appell’s  is 
thus  equivalent  to  the  projective  formulation. 


5.6.  Kane’s  method 

Kane’s  formalism  [11]  can  also  been  interpreted  geometrically  [12]  as  the  projection  of 
the  initial  dynamic  equations  (2)  (Newton-Euler  equations)  into  the  unconstrained  subspace. 
More  specifically,  the  generalized  active  K  and  inertia  K’  forces,  which  constitute  Kane’s 
equations,  can  be  interpreted,  using  the  notation  of  this  paper,  as  follows 

h-h= 0  <=>  K  +  K*  =0  o  Drf-DrM[(Du  + y)  +  d]  =  0  (26) 

The  partial  velocity  matrix  used  in  Kane’s  method  is  thus  the  matrix  D  which  relates  the  de¬ 
pendent  velocities  v  and  independent  generalized  speeds  u,  v  =  Du.  Kane’s  method  entails 
then  a  methodology  for  setting  up  equations  of  motion  in  a  practical  way  [11]. 
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6.  Other  useful  implementations 

6.1.  Geometric  elimination  of  constraint  violation 


Fig.  4.  The  elimination  of  constraint  violations. 


For  a  system  modeled  in  dependent  state  variables,  when  the  governing  equations  in¬ 
volve  constraint  equations  differentiated  with  respect  to  time,  one  consequence  of  numerical 
truncation  errors  is  violation  of  the  original  constraint  equations  by  the  numerical  solutions. 
The  geometrical  scheme  developed  in  [5,17]  lies  in  correcting  the  state  variables  so  that  to 
eliminate  the  constraint  violations  after  each  step  of  integrations  (a  sequence  of  steps).  An 
important  feature  of  the  corrections  is  that  they  are  performed  in  the  constrained  directions, 
and  do  not  influence  the  system  kinetic  motion  (Fig.  4).  For  a  current  numerical  position  p 
and  velocity  v  ,  <I>  =  <I>(p)  *  0  and  T  =  T(p,  v)  ^  0  are  measures  along  the  constrained  direc¬ 
tions  of  the  distance  from  p  to  the  virtual  holonomic  constraint  manifold,  and  of  projection  of 
v  into  these  constrained  directions.  The  appropriate  state  corrections  are  as  follows  [5]: 


Ap  =  -AM'ICr(CM'1Cr)‘‘ 


and  Av  =  -IVr’Cr(CIVr1Cr)"1'F  (27) 


where  Ap  =  p-p,  Av= v-v,  for  p  and  v  being  the  constraint  consistent  state  variables, 
<D(p)  =  0  and  'F(p,  v)  =  0 .  In  computations  the  position  correction  should  be  performed  first 
and  may  require  few  iterations.  Then,  the  velocity  correction  can  be  done  in  one  step. 


6.2.  Augmented  joint  coordinate  method 

The  formulation  of  ODEs  (16)  involves  only  the  explicit  constraint  equations  (13)  -  (15). 
If  the  constraint  reactions  X  need  to  be  determined  according  to  (17),  the  constraint  matrix  C 
is  required  in  addition,  i.e.  the  implicit  constraint  equations  (4)  and  (5)  need  to  be  introduced, 
and  this  means  additional  modeling  effort.  Another  inconvenience  of  scheme  (17)  is  that  the 
mxm  matrix  CM  'C7  must  be  inverted,  which  may  be  a  numerically  inefficient  task.  The 
novel  scheme  developed  in  [7]  is  released  from  the  inconveniences.  In  the  approach,  the  ex¬ 
plicit  constraint  equations  are  modified  to 


p  =  g(q,z) 


P  = 


ri  4- 

fdg) 

UqJ 

4  + 

2=0 

< fa J 

z  s  D(q)q  +  E(q)z 


(28) 


2=0 


where  both  the  joint  and  open-constraint  coordinates,  q  and  z,  are  involved  to  describe  the 
admissible  and  prohibited  relative  motions  in  the  joints.  The  explicit  constraint  equations  (13) 
and  (14)  are  then  retrieved  for  z  =  0  and  z  =  0 .  In  fact,  the  dependence  on  z  in  equations  (28) 
is  needed  only  to  grasp  the  prohibited  motion  directions  in  the  joints,  represented  as  columns 
in  the  nxm  matrix  E.  An  important  characteristic  of  matrix  E  is 
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CE  =  I  o  ErCr  =1  (29) 

where  I  is  the  mxm  identity  matrix.  In  other  words,  E  is  a  pseudoinverse  of  the  rectangular 
matrix  C  (refer  to  [7]  for  more  details).  Using  E,  the  new  projection  formula  is 

Drl(Mv  +  d  =  f-Crx)  =>  DrM(Dq  +  T)  +  D7d  =  Drf  (30a) 

ErJV  '  =>  ErM(Dq  +  y)  +  Erd  =  Erf  -X  (30b) 

The  tangential  projection  (30a)  leads  to  ODEs  (16),  and  (30b)  results  then  in 

Mq,q,q,0  =  ET(f-M(Dq  +  y))  (31) 

The  constraint  reactions  X  are  then  obtained  directly  in  a  “resolved”  form  -  no  matrix  inver¬ 
sion  is  required.  The  scheme  does  not  require  the  implicit  constraint  equations  (4)  -  (6).  In¬ 
stead,  the  explicit  constraint  equations  (13)  -  (15)  are  slightly  modified  to  the  forms  of  (28). 


6.3.  Geometric  interpretation  of  augmented  Lagrangian  formulation 
A  geometric  interpretation  of  the 


augmented  Lagrangian  formulation  [1] 
is  presented  in  [6],  Instead  of  imposing 
constraints  on  a  system  in  the  traditional 
sense,  large  artificial  masses  p  resisting 
in  the  constrained  directions  are  added, 
and  the  system  motion  is  enforced  to 
evolve  primarily  in  the  directions  with 
smaller  masses  (in  the  unconstrained 
directions).  Then,  the  residual  motion  in 
the  constrained  directions  is  removed  by 
applying  the  constraint  reactions  to  the 
system,  estimated  effectively  in  few  it- 


Fig.  5..  The  geometric  interpretation  of  the 
augmented  Lagrangian  formulation. 


erations.  The  formulation  is  simple  and 

leads  to  computationally  efficient  numerical  codes.  Applications  of  the  formulation  to  the 
analysis  of  constrained  multibody  systems  with  possible  singular  configurations,  massless 
links  and  redundant  constraints  can  are  shown  in  [6], 


6.4.  Orthonormalization  method 


The  final  example  of  implementations  stimulated  by  the  geometrical  interpretations  of 
multibody  systems  in  the  orthonormalization  method  proposed  in  [2].  An  effective  scheme  for 
converting  the  equations  of  motion  expressed  in  terms  of  absolute  variables,  DAEs  (9),  into  a 
convenient  minimal-form  set  of  equations  in  independent  kinematical  parameters  is  devel¬ 
oped.  Exploiting  the  fact  that  Tn  is  a  metric  space,  the  Gram-Schmidt  orthogonalization 

scheme  is  adopted  to  generate  a  genuine  orthonormal  basis  of  Dr ,  C _ or^°"°™fe»|i°n  ^ 

ing  the  orthonormal  basis  defined  by  D,  the  independent  kinematic  parameters  u  can  be  in¬ 
troduced,  v  =  Du,  and  the  dimensions  of  u  is  [^kg m/s],  just  between  the  dimensions  of 
momentums  M  vand  velocities  v.  A  useful  peculiarity  of  this  approach  is  that  in  the  minimal- 
form  dynamic  equations  (20b)  produced  this  way,  DrMD  =  I ,  i.e.  the  related  mass  matrix  is 
the  identity  matrix  (the  dynamic  equations  are  obtained  directly  in  a  “resolved”  form).  The 
method  is  especially  efficient  for  M  =  const ,  it  can  thus  be  considered  as  an  effective  solver 
for  absolute  variable  formulations. 
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7.  Conclusion 

The  geometrical  interpretation  of  multibody  system  dynamics  can  be  both  insightful  and 
stimulative.  Appealing  directly  to  the  geometry  of  particle  dynamics  known  from  Newtonian 
dynamics,  it  provides  one  with  a  precise  and  powerful  investigation  tool  for  handling  con¬ 
strained  motion  problems.  The  followed  mathematical  formulations  resolve  then  themselves 
to  compact  matrix  transformations  suitable  for  computer  implementations.  Systems  subject  to 
holonomic  and  nonholonomic  constraints  can  be  treated,  and  the  analysis  can  be  performed  in 
either  generalized  or  quasi-velocities.  Variant  forms  of  equations  of  motions  can  be  obtained, 
relevant  to  many  other  methods  of  classical  mechanics.  Finally,  novel  contributions  and 
amendments  in  the  theory  of  constrained  systems  can  be  stimulated. 
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Abstract 

Motions  of  plane  multilink  mechanisms  over  a  horizontal  plane  are  investigated.  The 
system  under  consideration  is  a  multibody  system  consisting  of  rigid  bodies  connected  by 
revolute  joints  with  vertical  axes.  Control  torques  are  created  by  actuators  placed  at  the 
joints.  Dry  friction  forces  between  the  linkage  and  the  horizontal  plane  act  upon  the  system. 
It  is  shown  that  the  system  under  consideration  can  perform  lengthwise,  sideways,  and  ro¬ 
tational  motions  in  the  horizontal  plane  so  that  it  can  reach  any  position  and  orientation  in 
the  plane.  Control  laws  for  various  modes  of  periodic  and  wave-like  motions  are  proposed  for 
multilink  mechanisms  with  different  number  of  links:  two,  three,  and  many.  The  displace¬ 
ments  and  speed  of  motion  are  estimated.  Optimal  geometrical  and  mechanical  parameters 
of  linkages  are  determined.  Ihe  results  of  computer  simulation  as  well  as  experimental  results 
confirm  the  obtained  theoretical  calculations. 

Keywords:  modelling,  control,  multibody  system,  biomechanics. 


1  Introduction 

Ciawling  motions  of  snakes,  worms,  and  other  limbless  animals  have  always  been 
of  great  interest  for  specialists  in  mechanics  and  biomechanics.  Different  aspects 
of  snake-like  motions  are  considered,  for  example,  in  [1-7].  Biomechanical  studies 
show  that  snakes  always  try  to  use  vertical  or  inclined  objects  (walls,  stones, 
grass,  and  other  obstacles)  to  exert  forces  having  projections  on  the  direction  of 
motion  and  thus  to  compensate  dry  friction.  Snake-like  nonholonomic  mechanism 
considered  in  [4]  and  other  papers  consists  of  many  elements  having  wheels  and 
connected  by  joints.  By  twisting,  these  mobile  multilink  robots  achieve  the  similar 
result:  the  wheels  exert  on  the  surface  horizontal  forces  perpendicular  to  the 
wheels  and  thus  produce  the  desirable  forces  in  the  direction  of  motion. 

In  this  paper,  we  consider  simple  plane  multibody  systems  (linkages)  without 
wheels  which  can  move  along  the  horizontal  plane  in  the  presence  of  dry  friction 
between  the  linkage  and  the  plane.  Control  torques  are  created  by  actuators 
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installed  at  the  joints  of  the  linkage.  It  is  shown  that  the  linkage  can  peform 
various  motions  along  the  plane.  For  a  three-link  system  which  is  investigated  in 
more  detail,  and  for  a  two-link  system  the  motion  consists  of  slow  and  fast  phases. 
For  a  linkage  with  more  than  four  links,  a  slow  wave-like  motion  is  possible. 
Displacements  and  speed  of  the  motions  are  estimated.  The  paper  is  based  on 
the  results  obtained  in  [8-12]. 

2  Three-link  mechanism 

Consider  a  plane  linkage  O1C1C2O2  moving  over  a  horizontal  plane  Oxy  (Fig.  1). 
For  the  sake  of  simplicity,  we  assume  that  the  links  OiCj ,  C1C2,  and  C2O2  are  rigid 
and  massless  bars,  and  the  mass  of  the  linkage  is  concentrated  at  its  joints  C\  and 
C2  which  are  equal  point  masses  mi,  and  at  the  end  points  0\  and  O2  which  are 
equal  point  masses  mo-  Thus,  the  total  mass  of  the  linkage  is  m  =  2(m\  +mo). 
The  length  of  the  central  link  C1C2  is  2a.  and  the  lengths  of  the  end  links  are 
equal  to  t.  Denote  by  x,y  the  coordinates  of  the  middle  of  the  control  link,  by 
6  the  angle  between  this  link  and  the  x-axis,  and  by  a,-  the  angles  between  the 
central  link  and  the  end  links  =  1,2  (Fig.  1). 


Fig.  1.  Three-member  linkage.  Fig.  2.  Longitudinal  motion. 

Suppose  the  dry  friction  acting  between  the  masses  Oi,Cj,z  =  1,2,  and  the 
horizontal  plane  obeys  Coulomb’s  law.  If  a  point  mass  m  moves,  the  friction  force 
is  opposite  to  the  point  velocity  and  equal  to  its  weight  mg  multiplied  by  the 
friction  coefficient  k.  If  the  point  mass  is  at  rest,  the  friction  does  not  exceed 
mgk ,  and  its  direction  can  be  arbitrary.  We  assume  that  the  friction  coefficient 
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for  the  masses  mi  and  mg  is  equal  to  k\  and  ko ,  respectively.  The  control  torques 
Mi  and  M2  are  applied  at  the  joints  C\  and  C2.  Suppose  that  these  torques  can 
produce  some  prescribed  time-history  of  angles  cq(f),f  =  1,2. 

We  will  construct  the  desired  motions  of  the  linkage  as  a  combination  of  more 
simple  motions  which  we  call  elementary  [8].  All  elementary  motions  begin  and 
end  at  the  states  of  rest  of  the  linkage.  In  each  elementary  motion,  the  angles 
=  1,2,  change  within  the  interval  (— tt, tt)  between  the  prescribed  ini¬ 
tial  value  and  terminal  value  aj;  the  time-histories  <*,■(£)  can  be  more  or  less 
arbitrary.  If  both  angles  cq(£)  take  part  in  the  elementary  motion,  then  they  ro¬ 
tate  synchronously  either  in  the  same  direction,  or  in  opposite  directions,  so  that 
a2{t)  =  ±Qi(t). 

Elementary  motions  are  divided  into  slow  and  fast  ones. 

In  slow  motions,  the  angular  velocities  and  accelerations  of  the  end  links  are 
small  enough,  so  that  the  central  link  does  not  move.  Denote  by  ujq  and  so  maximal 
values  of  the  angular  velocities  and  accelerations  during  the  slow  motions 

ujq  =  max  |or,-(£)|,  s0  =  max|d,(f)|  (2.1) 

Here,  the  maxima  are  taken  along  the  whole  slow  motion.  They  do  not  depend 
on  i  =  1, 2. 

The  sufficient  condition  which  ensures  that  the  central  link  stays  at  rest  during 
the  slow  motion  can  be  expressed  as  follows  [10] 

rnQe{[uj40  +  (s0  +  0V1)2]172  +  (e0  +  £ V1)^-1}  <  rnygkx  (2.2) 

This  condition  holds  in  the  case  of  one  rotating  end  link  and  also  in  the  case  where 
both  links  rotate  in  the  same  direction.  If  the  end  links  rotate  in  the  opposite 
directions,  this  condition  can  be  replaced  by  a  weaker  one  [10] 

m^[ul  +  (s0  +  #_1)2]I/2  <  rri]_gk\  (2.3) 

Note  that  condition  (2.2)  always  holds  for  very  slow  motions,  i.e.,  if  u>q  and  So  in 
(2.1)  are  sufficiently  small,  and  rrioko(a  + 1)  <  mik\a.  Similarly,  condition  (2.3) 
holds,  if  ujq  and  s0  are  sufficiently  small  and  mo&o  <  m ik\. 

In  fast  motions,  the  angular  velocities  and  accelerations  of  the  end  links  are 
sufficiently  high,  and  the  duration  r  of  this  motion  is  much  less  than  the  duration 
T  of  the  slow  motion:  r  <  T.  The  magnitudes  of  the  control  torques  Mi  and  M2 
during  the  fast  motion  are  high  compared  to  the  torques  produced  by  the  friction 
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|  Mil^m'gk't,  i  =  l,2 

m*  =  max(m1,m0),  k*  =  max(ki,k0),  a*  =  ma,x(aj)  '  '  ' 

Hence,  the  friction  can  be  neglected  during  the  fast  motion.  Therefore,  the  center 
of  mass  of  the  linkage  stays  at  rest,  and  its  angular  momentum  is  zero  during  the 
fast  motion.  Using  these  conservation  laws,  one  can  easily  evaluate  the  terminal 
state  of  the  linkage  after  the  fast  motion. 

3  Construction  of  motions 

Let  at  the  initial  state  the  linkage  be  at  rest,  with  all  its  links  parallel  to  the 
x-axis.  We  have  9  =  a\  =  <a2  =  0  in  this  state  (Fig.  2). 

The  longitudinal  motion  is  implemented  by  means  of  the  following  stages  (Fig. 
2).  In  what  follows,  we  denote  slow  and  fast  motions  by  capital  S  and  F ,  respec¬ 
tively,  indicating  the  initial  and  terminal  values  a0  and  a 1  of  angles  a*  in  each 
elementary  motion  as  follows  a*  :  a*-  — >  a},  i  =  1,2. 

Using  this  notation,  the  longitudinal  motion  of  a  three-member  linkage  is  de¬ 
scribed  as  follows  (Fig.  2). 

1  ■  S,  :  0  — >•  7,  ar2(£)  =  0. 

2.  F,  ai  :  7  ->  0,  07  :  0  — >  7. 

3.  S,  a>i  :  0  — >  -7,  07  :  7  ->  0. 

4.  F,  Q'i  :  —7  — >  0,  Q'2  :  0  — y  -7. 

5.  S ,  Q'i  :  0  — >  7,  a2  •  —7  — >  0. 

Here,  7  E  (— 7v,n)  is  some  fixed  angle. 

After  stage  5,  the  configuration  of  the  linkage  becomes  identical  to  its  config¬ 
uration  after  stage  1:  a\  =  7,  a2  =  0.  The  cycle  of  four  elementary  motions  2-5 
can  be  repeated.  To  return  the  linkage  to  its  original  rectilinear  configuration 
ai  —  a2  =  0,  it  is  sufficient  to  perform  the  slow  motion:  S,  07  :  7  -7  0,  cr2  =  0. 

During  the  slow  motions,  the  central  link  stays  at  rest,  whereas  the  center  of 
mass  of  the  linkage  moves.  During  the  fast  motions,  on  the  contrary,  the  center  of 
mass  stays  at  rest,  while  the  central  link  moves.  It  is  shown  in  [8]  that  the  total 
displacement  of  the  central  link  along  the  x-axis  during  the  cycle  of  motions  2-5 
is 

Ax  =  8m0m_1£sin2(7/2),  m  =  2(m0  +  mi)  (3.1) 

The  total  ‘displacement  of  the  middle  of  the  central  link  along  the  y-axis  and 
the  total  angle  of  rotation  of  this  link  during  the  same  cycle  are  zero:  Ay  =  0, 
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A0  =  0.  The  average  speed  of  the  longitudinal  motion  is 


Vi  =  Ax{2  T)~\ 


(3.2) 


Fig.  3.  Lateral  motion. 


Lateral  motion  can  be  performed  as  follows  (Fig.  3). 

1-  S,  c^i  :  0  — >  -7,  a2  :  0  ->  -7. 

2.  F,  an  :  -7  ->  7,  a2  ;  7  ->  -7. 

3.  5,  (*1  :  7  — >  -7,  a2  :  -7  — >  7. 

After  stage  3,  the  configuration  of  the  linkage  is  identical  to  its  configuration 
after  stage  1:  Q'i  =  -7,  a2  =  7.  The  cycle  of  motions  2,  3  can  be  repeated. 
To  return  to  the  original  rectilinear  configuration  a}  =  a2  -  0,  it  is  sufficient  to 
perform  the  motion:  S,  on  :  -7  — »  0,  ot2  :  7  — >  0.  During  the  cycle  of  motions 
2,  3,  the  total  displacement  of  the  middle  of  the  central  link  along  the  27-axis  and 
the  total  rotation  are  zero:  Ax  =  0,  A9  =  0,  whereas  the  total  displacement 
along  the  y- axis  and  the  average  velocity  along  this  axis  are  [8] 


Ay  =  4m0m  ^siny,  v2  =  AyT~l 


(3.3) 


The  rotation  of  the  linkage  can  be  performed  as  follows  (Fig.  4). 

1.  5,  Qfi  :  0  — v  71,  a2 :  0  — »  71 . 

2.  F,  Qfi  :  7i  — >  72,  a2  :  7!  72. 

3.  S,  Q’i  :  72  ->  7l5  a2  :  72  ->  7^ 

Here,  7:  and  72  are  angles  from  the  interval  (-7r,7r).  Motions  2,  3  can  be 
repeated.  To  return  the  linkage  to  the  initial  rectilinear  state  =  a2  =  0, 
it  is  necessary  to  perform  the  motion:  S ,  on  1  :  71  — >■  0,  a2  :  7L  — >  0.  The 
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total  displacement  of  the  middle  of  the  central  link  during  the  cycle  2,  3  is  zero: 
Ax  —  Ay  —  0,  and  the  angle  of  rotation  A 6  can  be  easily  evaluated  [8]. 

Combining  the  motions  described  above,  the  linkage  can  perform  arbitrary 
displacement  in  the  horizontal  plane. 

4  Two-member  linkage 

Consider  now  a  system  of  two  bodies  connected  by  a  joint  O*  which  can  move 
along  the  horizontal  plane  Oxy.  The  masses  of  the  bodies  are  denoted  by  mi  and 
m2,  their  centers  of  masses  by  C\  and  C2,  their  moments  of  inertia  about  the  axis 
O*  by  J\  and  J2,  the  distances  0*C\  and  0*C2  by  ai  and  <22,  and  the  friction 
coefficients  for  these  bodies  by  k\  and  &2,  respectively.  The  body  with  index  1 
will  be  referred  to  as  a  body,  whereas  the  body  with  index  2  will  be  called  a  tail 
(Fig.  5).  The  joint  O*  is  considered  as  a  point  mass  mo  with  a  friction  coefficient 
k0. 

We  again  consider  the  motion  of  the  linkage  along  the  horizontal  plane  Oxy. 
The  torque  at  the  joint  O*  is  denoted  by  M.  The  coordinates  of  the  joint  O*  are 
denoted  by  x,y,  the  angle  between  0*C\  and  Ox  by  #,  and  the  angle  between 
C2O*  and  0*C\  by  cq  (Fig.  5). 

Again,  we  introduce  the  notion  of  slow  and  fast  motions.  In  the  slow  motions, 
the  tail  rotates  slowly  enough,  so  that  the  body  stays  at  rest.  In  the  fast  motions, 
the  friction  can  be  neglected,  so  that  the  conservation  of  momentum  and  angular 
momentum  holds. 

Denote 

—  max  |d(£)|,  £q  =  max  |d(t)|  (4.1) 

where  the  maxima  are  taken  along  the  slow  motion.  Then  the  following  two 
inequalities  are  a  sufficient  condition  which  ensures  that  the  body  stays  at  rest 
during  the  slow  motions  of  the  tail  [11] 

J2£q  +  m2gk2a2  <  migkiai 

J2£ 0  +  m2gk2a2  +  m2aia2[wo  +  (eo  +  1)1/2]  <  ^o^oai 

These  inequalities  always  hold  for  very  slow  motions,  if  loq  and  £0  in 
sufficiently  small  and  the  following  two  inequalities  are  true 

m.2&2a2  <  m2k2(ai  +  £12)  <  Wo^oGi 

The  following  sequence  of  elementary  motions  constitute  the  longitudinal  mo¬ 
tion  of  a  two-member  linkage  (Fig.  6). 


(4.2) 
(4.1)  are 
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1.5,  a  :  0  ->  (5. 

2.  F,  a:P-+  0. 

3.  5,  a  :  0  ->  -P 

4.  F,  a  :  —  P  — >•  0 

5.  5,  a  :  0  -»  —  /?. 

6.  F,  a  :  -P  ^  0. 

7.  5,  a  :  0  ->  p. 

8.  F,  a  :  P  ->  0 


Fig.  5.  Two-member  linkage. 


Fig.  6.  Longitudinal  mo¬ 
tion  of  a  two-member  linkage. 


Here,  P  is  some  fixed  angle,  P  £  (— 7r,  n).  As  a  result  of  this  sequence  of 
motions,  the  linkage  moves  along  itself  by  the  distance  [11] 

Ax  =  8m-1m2a2  sin  ~  cos  ^  sin  (4.3) 

the  total  lateral  motion  and  rotation  being  zero. 

In  (4.3),  the  following  denotations  are  used 
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(4.4) 


m  =  m0  +  mi  +m2,  7  =  f  +  ^^arctg 

Aq  —  m(  J2  —  J\)  +  rn\a\  —  m^a2 

A i,2  =  [m(Ji  +  J2)  -  (miai  ±  m2a2)2]1/2 

The  average  speed  of  the  longitudinal  motion  is  v%  =  Ax/ (4 T).  It  can  be 
shown  that,  combining  slow  and  fast  motions,  the  two-member  linkage  can  per¬ 
form  arbitrary  displacements  in  the  horizontal  plane. 

5  Multilink  systems 

Motions  of  multilink  systems  along  a  horizontal  plane  are  investigated  in  [9].  For 
these  systems,  wave-like  modes  of  motion  are  proposed  in  which  only  several  (three 
or  four)  links  move  at  each  instant  of  time.  Due  to  the  wave  travelling  along  the 
linkage,  the  multilink  system  can  move  as  a  whole  in  the  longitudinal  direction. 
These  periodic  motions  do  not  include  fast  phases  and  can  be  carried  out  as  slow 
quasi-static  motions.  The  required  torques  created  by  the  actuators  are  rather 
small:  they  do  not  exceed  2 mgk£,  where  m  is  a  mass  of  the  link,  £  is  its  length, 
and  k  is  the  coefficient  of  friction.  Note  that  for  the  fast  motions  considered  above 
the  required  torque  is  much  higher:  M  mgk£ ,  see  (2.4).  The  slow  wave-like 
motions  can  be  performed  by  multilink  systems  having  more  than  four  links. 

6  Example 

Consider  a  three-link  mechanism  having  the  following  parameters 

a  =  £  =  0.2m,  mi  =  1.2%,  m^  —  OAkg 
m~  3.2kg,  ki  =  ko  =  0.2,  g  —  9.81m  -  s-2 
Let  the  angular  velocities  in  the  slow  motions  obey  the  piecewise  linear  law 

0Ji(t)  =  e of,  t  E  [0,T/2];  Wi(t)  =  £q(T  —  t),  £(E|T/2,T] 

uji(t)  =  |dr£(f)|,  i  =  1,2;  w0  =  e0T/2,  |Aar|  =  |aj  -  a°|  =  eqT2/ 4 

with  er0  =  4s~2.  The  maximal  angle  of  rotation  of  the  end  links  is  7  =  lrad.  Then 
for  the  logitudinal  motion  we  have  |Aor|  =  1,  T  —  Is,  w0  =  2s-1,  whereas  for 
the  lateral  motion  |Aor|  =  2,  T  =  1.4s,  ui 0  =  2.8s-1.  The  conditions  (2.2)  and 
(2.3)  for  both  motions  are  satisfied,  and  their  velocities,  according  to  (3.1)-(3.3), 
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are  v\  —  0.023 m-s  *,  V2  —  0.034m -s  b  The  required  magnitude  of  control  torques 
evaluated  according  to  (2.4)  is  6  +  8N  •  m. 

7  Optimization 

The  average  speed  of  motion  of  linkages  depends  on  their  geometrical  and  mechan¬ 
ical  parameters  such  as  lengths  and  masses  of  links,  angles  of  rotation,  coefficients 
of  friction,  etc.  Parametric  optimization  of  the  average  speed  (see  (3.2))  of  the 
three-member  and  two-member  linkages  with  respect  to  their  parameters  is  per¬ 
formed  in  [12]. 

Let  us  note  some  properties  of  optimal  solutions.  The  average  speed  grows 
with  the  increase  of  the  angle  of  rotation  of  the  links.  Also,  it  grows  with  the 
coefficient  of  friction  of  the  main  body  k\,  both  for  the  three-member  and  two- 
member  linkages.  For  the  three-member  linkage,  the  optimal  length  l  of  the  end 
links  is  greater  than  the  half-length  a  of  the  central  link:  £  >  a.  By  contrast, 
the  optimal  length  a 2  of  the  tail  of  the  two-member  linkage  is  smaller  than  the 
half-length  of  its  body:  a 2  <  a\j 2.  The  gain  in  speed  due  to  the  optimization  of 
lengths  and  masses  is  rather  essential,  up  to  50%  and  more. 

It  is  shown  that  the  maximal  longitudinal  speed  of  the  three-member  linkage 
can  be  estimated  by  the  formula 


uj  ~  0.l{gak])l/2  (7.1) 

The  maximal  speed  of  the  lateral  motion  is  several  times  higher. 

The  maximal  speed  of  the  two-member  linkage  is  approximately  two  times 
smaller  than  v\  from  (7.1).  This  difference  can  be  easily  explained  by  the  fact 
that  the  three-member  linkage  is  equipped  with  two  actuators,  whereas  the  two- 
member  linkage  has  only  one. 

8  Conclusions 

A  plane  linkage  consisting  of  two,  three,  or  more  bodies  can  move  over  a  rough 
horizontal  surface  in  different  directions  using  internal  control  torques  created  by 
the  actuators  placed  at  the  joints.  The  vehicle  has  a  very  simple  structure  and 
can  use,  m  fact,  only  one  actuator.  Different  modes  of  motions  are  described,  and 
sufficient  conditions  are  derived  which  ensure  the  possibility  of  required  motions. 
Estimates  of  displacements,  average  speed,  and  required  control  torques  are  given. 
Maximization  of  the  average  speed  of  linkages  with  respect  to  their  geometrical 
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and  mechanical  parameters  is  performed.  Computer  simulation  of  the  motion 
of  linkages  is  carried  out  based  on  the  numerical  integration  of  complete  sets  of 
nonlinear  differential  equations  of  the  linkages.  Results  of  the  simulation  confirm 
theoretical  considerations  and  estimates.  Because  of  the  simplicity  of  the  structure 
of  snake-like  mechanisms,  the  proposed  principle  of  motion  can  be  useful  for  mobile 
robots,  especially  for  small  ones.  First  experiments  performed  at  the  Technical 
University  of  Munich  by  Prof.  F.Pfeiffer,  Mr.  Gienger,  and  Mr.  Mayr  show  that 
the  snake-like  motions  described  above  can  be  implemented. 

The  work  was  supported  by  the  Russian  Foundation  of  Basic  Research,  project 
N  02-01-00201. 
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1.  Introduction 


e  hearing  organ,  a  marvelous  and  highly  developed  part  in  the  human 
body  provides  a  very  important  sense  in  the  daily  life.  In  the  middle  ear 
there  are  pure  mechanical  mechanisms  of  sound  transfer  whereas  in  the 
inner  ear  a  complex  transduction  from  mechanical  entities  via  chemical 
processes  to  electrical  stimulation  of  hearing  nerves  take  place.  In  case  of 
hearing  loss  due  to  diseases  or  accidents  a  mechanical  reconstruction  is 
performed  by  inserting  passive  or  active  implants  into  the  middle  ear. 

2.  Aims  and  Motivation 


Virtual  scenarios  of  the  complex  hearing  process  for  pathological  situations 
are  becoming  an  increased  meaning  in  the  clinical  practice  to  diagnose  and 
to  reconstruct  an  impaired  hearing  successfully: 

The  audiologist  needs  a  deep  insight  into  the  dynamical  behavior  of 
the  mechanical  middle  ear  structures  to  give  a  correct  diagnosis  about 


or  a  successful  reconstruction  the  surgeon  must  have  a  detailed  knowl¬ 
edge  about  the  frequency  dependent  spatial  motion  of  the  ossicular 
chain  during  sound  transfer  through  the  middle  ear  to  assess  the  ef¬ 
fects  of  surgical  manipulations.  For  reconstructions  he  has  to  choose 
an  appropriate  implant  and  to  insert  it  in  a  suitable  manner 
“  Jhe  devel°Pper  of  passive  and  actively  driven  implants  has  to  regard  the 
dynamics  of  the  implant  itself  together  with  the  dynamical  behavior  of 
the  remaining  middle  ear  structure  in  the  design  and  the  optimization 
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By  virtue  of  simulation  of  the  hearing  process  and  animation  of  the  spatial 
motion  of  the  middle  ear  structures  ’virtual  hearing’  can  be  carried  out  and 
demonstrated  at  the  computer  which  serves  as  a  common  base  for  the  work 
of  audiologists,  surgeons  and  developers  of  implants.  This  procedure  needs 
appropriate  models  with  different  complexity  arid  confident  parameters  to 
describe  linear  and  nonlinear  effects  of  sound  transfer  through  the  outer 
and  middle  ear. 


3.  Modeling  of  the  Hearing  Mechanism 


To  describe  the  dynamical  behavior  of  the  hearing  organ  mechanical  and 
electrical  models  are  used.  With  models  based  on  electrical  circuits  only  the 
global  sound  transfer  is  described  between  the  scalar  input  pressure  p  and 
the  scalar  output  of  ’hearing’,  e.g.  Zwislocki  [1]  and  Shaw  and  Stinson  [2], 
These  models  were  derived  from  electro-acoustical  and  electro- mechanical 
analogies  based  on  very  strong  simplifications.  Due  to  the  simplifications 
and  the  non-physical  description  they  are  less  meaningful  and  less  flexible 
than  mechanical  models. 

Finite  element  models  of  tympanic  membrane  and  ossicles  were  pub¬ 
lished  by  Wada  et  al.  [3],  Beer  et  al.  [4]  and  Prendergast  et  al.  [5].  This 
approach  leads  to  large  systems  with  a  huge  number  of  parameters. 

With  three-dimensional  multibody  system  models  of  the  human  ossic¬ 
ular  chain  presented  in  [6],  the  spatial  motion  of  ossicles  can  be  described. 
The  methods  of  continuous  systems,  finite  element  systems  and  in  particular 
multibody  systems  are  used  here  to  model  the  air  in  the  outer  ear  canal, 
the  tympanic  membrane,  the  ossicles  of  the  middle  ear  with  its  visco-elastic 
ligaments  and  the  fluid  of  the  inner  ear.  For  the  outer  ear  canal  an  air 
column  in  a  rigid  cylindrical  tube  is  considered.  Modeling  the  air  column 
as  a  lumped  mass  system  allow  the  description  of  the  natural  frequencies  in 
the  frequency  range  of  the  human  hearing.  The  finite  element  approach  is 
used  to  describe  the  membrane  with  its  nonuniform  thickness  and  bending 
stiffness  in  order  to  derive  a  lumped  mass  model  which  is  coupled  with 
the  air  column  and  the  ossicular  chain.  The  three  ossicles  are  modeled  as 
rigid  bodies  spatially  suspended  by  the  ligaments  in  the  air-filled  middle 
ear  cavity.  The  ligaments  are  considered  as  massless  spring/damper  com¬ 
binations  [7].  In  figure  1  the  final  multibody  system  model  of  the  hearing 
mechanism  is  shown  with  the  ear  canal,  the  ear  drum,  the  rigid  bodies  of  the 
ossicles  and  the  inner  ear  fluid.  Using  a  multibody  systems  formalism  [8], 
the  equation  of  motion  can  be  generated  in  a  symbolical  form 

My  +  k  =  q ,  (1) 
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Figure  1.  Mechanical  model  of  the  middle  ear  and  its  adjacent  structures  air  of  outer 
ear  canal,  ear  drum,  and  fluid  of  inner  ear.  The  ligaments  and  muscles  are  indicated  as 
black  lines.  In  particular  the  translations  xh,  Vh  and  zH  and  rotations  aH)  Ph  and 

of  the  incudo-malleal  block,  translation  ys  and  rotations  as,  and  js  of  the  stapes  are 
specified. 


with  the  generalized  coordinates  y  E  Mf ,  the  mass  matrix  M,  the  vec¬ 
tor  of  generalized  centrifugal,  Coriolis  and  gyroscopic  forces  k  and  the 
vector  of  generalized  applied  forces  q.  The  entire  model  of  a  normal  ear 
has  f  =  77  degrees  of  freedom  comprising  the  air  in  the  ear  canal,  the 
tympanic  membrane,  the  ossicles  and  parts  of  the  inner  ear. 

For  moderate  sound  pressure  levels  linear  kinematics  and  linear  consti¬ 
tutive  equations  can  be  assumed  and  the  joint  between  malleus  and  incus  is 
considered  as  fixed  [3].  Then  the  equation  (1)  can  be  linearized  to  perform 
eigenvalue  analysis.  For  high  sound  pressure  levels  and  in  particular  for 
impulsive  noise,  a  nonlinear  behavior  of  the  middle  ear  occur.  This  is  due 
to  a  nonlinear  kinematic  as  well  as  to  nonlinear  constitutive  equations  of 
the  ligaments  and  the  ear  drum.  Moreover  the  deflection  of  some  elements 
in  the  middle  ear  like  the  annular  ring  is  limited.  Another  source  of  non¬ 
linear  behavior  are  the  active  processes  in  the  inner  ear.  For  high  force 
intensity  the  joint  between  malleus  and  incus  is  articulated  for  decoupling 
both  ossicles  like  a  mechanical  safety  clutch  to  prevent  the  hearing  from 
overload. 
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Figure  2.  Asymmetric  stiffness  and  limited  transfer  force  of  a  ligament  or  coupling 
between  implant  and  ossicle. 


Distinct  pathological  situations  like  otosclerosis  or  partial  malleus  head 
fixation  can  be  described  with  the  established  models  by  changing  of  specific 
parameters  or  the  structure  of  the  models. 

Reconstructions  of  the  middle  ear  structure  are  carried  out  to  repair 
missing  or  disfunctional  parts  of  the  ossicular  chain.  Passive  implants  are 
used  to  replace  ossicles  in  order  to  bridge  a  gap  in  the  ossicular  chain.  Here 
the  attachment  points  of  implant  and  ossicles  determine  the  kinematics  of 
the  reconstructed  ear.  The  coupling  conditions  between  ossicles  and  implant 
influence  the  dynamic  of  the  spatial  motion  of  the  reconstructed  ear.  Active 
implants  additionally  can  drive  the  middle  ear  in  order  to  compensate 
hearing  losses  due  to  imperfect  sound  transfer  of  the  middle  ear  or  damaged 
inner  ear  [9].  They  can  act  as  force  or  displacement  transducers  imposing 
a  translational  or  a  rotational  motion.  Beside  the  attachment  point  and 
coupling  conditions  between  implant  and  ossicle,  the  spatial  orientation  of 
the  excitation  is  essential.  A  restricted  coupling  force  and  a  distortion  due 
to  nonlinear  coupling  mechanisms  may  lead  to  unacceptable  hearing  results. 
On  the  base  of  the  models  of  the  natural  ear,  models  of  ears  reconstructed 
with  passive  or  active  implants  have  also  been  established  applying  the 
multibody  system  approach. 

Generally,  the  mechanism  of  coupling  is  highly  nonlinear  due  to  gaps  or 
asymmetrical  stiffness  and  damping  behavior  with  respect  to  inward  and 
outward  movement.  In  particular  the  commonly  used  intermediate  medium 
between  prosthesis  and  ossicles  like  fascia  show  approximately  a  behavior 
with  partially  linear  force/displacement  relation  as  sketched  in  figure  2. 
In  some  cases  the  coupling  between  implant  and  ossicle  is  performed  by 
pressing  both  parts  against  it.  Then  a  so-called  unilateral  constraint  is  given 
which  shows  a  highly  nonlinear  behavior.  Such  a  asymmetric  stiffness  of 
the  springs  may  lead  to  harmonic  distortion  in  the  sound  transfer  through 
the  middle  ear  even  in  the  case  of  moderate  excitation.  Using  powerful 
active  implants,  the  applied  excitation  may  cause  high  coupling  forces  which 
exceed  a  physical  limit  and  leading  also  to  a  distorted  sound  transfer.  They 
may  also  cause  feedback  effects  which  inhibit  the  full  compensation  of  a 
particular  disease. 


prejturr  [daP»] 


Figure  3.  Spectrum  of  velocity  of  the  umbo  depending  on  static  pressure  p  in  ear  canal 
for  simulation  (left)  and  measurement  (right). 


4.  Measurements  and  Parameter  Estimation 


Measurements  in  the  clinical  practice  and  in  the  lab  have  been  conducted 
to  determine  the  dynamical  behavior  of  the  hearing  organ  and  to  derive  the 
belonging  parameters  of  the  models.  Due  to  the  very  small  displacements 
and  velocities  and  the  low  masses,  non-contact  measurement  principles  like 
laser  Doppler  vibrometry  (LDV)  have  to  be  applied. 

Especially  nonlinear  effects  could  be  detected  by  using  LDV  and  ex¬ 
tended  procedures  of  the  multifrequency-tympanometry  (MFT).  In  the 
classical  tympanometry  a  varying  static  pressure  in  the  ear  canal  but  only 
a  fixed  excitation  frequency  is  used  to  determine  the  acoustical  properties 
of  the  middle  ear.  Applying  modern  measurement  and  data  processing 
techniques  of  the  MFT,  the  nonlinear  mechanical  properties  of  the  middle 
ear  structures  become  apparent.  Taking  the  simulated  velocity  of  the  tip 
of  malleus  handle  (umbo)  and  calculating  the  spectrum  a  contour  plot 
results  as  shown  in  figure  3  left  part.  The  corresponding  plot  resulting 
from  measurement  with  LDV  is  shown  on  the  right  part  of  figure  3.  These 
diagrams  are  called  local  multifrequency-tympanometry  (LMFT)  due  to 
their  similarity  to  those  obtained  from  MFT  [10].  The  shift  in  the  natural 
frequencies  can  be  seen  due  to  the  nonlinear  behavior  of  the  ear  drum 
and  the  middle  ear  ligaments.  Comparing  measurements  of  the  MFT  with 
simulations,  the  nonlinear  behavior  of  the  models  could  be  approximated 
by  power  series.  Based  on  virtual  MFT  diagrams  the  influence  of  particular 
pathologies  like  malleus  head  fixation  or  otosclerosis  can  be  studied.  The 
investigations  for  describing  nonlinearities  in  the  sound  transfer  and  for 
parameter  estimations  are  still  ongoing. 
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5.  Virtual  Prototyping 

Based  on  the  results  of  the  simulations  and  animations  the  surgeon  is  able  to 
predict  the  effect  of  particular  surgical  incisions.  For  developers  of  implants 
virtual  ’test  series’  can  be  carried  out  by  including  the  models  of  existing 
implants  or  new  prototypes  in  the  entire  model.  This  allows  the  improve¬ 
ment  of  passive  and  active  implants  with  respect  to  specific  conditions  in 
the  middle  ear.  This  is  very  effective  since  particular  parameters  can  be 
varied  while  remaining  conditions  are  kept  constant.  Such  virtual  tests  are 
helpful  to  shorten  clinical  trial  series  with  living  animals  or  human  patients. 

An  optimization  of  hearing  result  is  not  only  focused  on  the  design  of 
the  implant  itself  but  includes  the  dynamic  behavior  of  the  entire  system 
with  the  particular  way  of  inserting  of  the  implant  by  the  surgeon.  One  part 
of  the  parameters  of  the  model  are  given  by  the  specific  anatomy.  Another 
part  can  be  chosen  by  the  designer  of  implants  and  by  the  surgeon,  they 
are  denoted  as  design  variables  p.  Some  parameters  q  may  vary  due  to 
operational  conditions  which  cannot  be  influenced.  Adjusting  the  design 
variables  the  sound  transfer  through  the  ear  can  be  improved  applying  an 
optimization  procedure.  The  goal  is  may  be  the  best  compensation  of  a 
particular  disease  or  to  get  a  good  sound  transfer  in  a  particular  frequency 
range  associated  with  a  low  sensitivity  against  variations  in  the  parame¬ 
ters  q  to  get  a  sufficient  robustness.  For  this,  appropriate  criteria  of  the 
kind 

=  *  =  l(l)n,  (2) 

have  to  be  formulated  assessing  the  dynamical  behavior  of  the  system. 
These  criteria  have  to  be  minimized  applying  an  appropriate  optimization 
algorithm  [11]. 

To  show  the  optimization  of  a  passive  implant,  in  figure  4  the  frequency 
dependent  response  of  the  inward/outward  motion  of  stapes  for  a  normal 
ear  and  reconstructed  ears  are  plotted.  The  sound  transfer  is  strongly 
governed  by  the  position  of  the  points  where  the  implant  is  attached  to 
the  ossicles  and  the  coupling  conditions  which  are  set  as  design  variables. 
The  surgeon  is  able  to  choose  the  position  of  attachment  as  well  as  the 
coupling  conditions  by  adjusting  the  statical  preload  between  ossicle  and 
implant.  For  the  optimization  two  criteria  have  been  formulated:  To  assess 
the  loudness,  the  amplitude  ys  of  inward/outward  motion  of  the  stapes 
should  be  large  in  the  whole  frequency  range.  To  assess  the  sound  quality, 
the  dependence  on  frequency  should  similar  to  the  normal  ear.  Taking  both 
criteria  into  account  and  applying  a  multi- criteria  optimization  a  better 
performance  is  obtained  as  shown  in  figure  4. 

For  an  optimal  design  and  use  of  passive  and  active  implants  reliable 
models  of  the  entire  hearing  organ  are  needed.  They  have  to  describe 
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Figure  4.  Comparison  in  the  frequency  response  of  normal 


ear  and  reconstructed  ears. 


the  three-dimensional  motion  and  nonlinear  behavior  of  the  mechanical 
structure. 
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Abstract 

Fundamentally  new  ground  vehicle  virtual  proving  ground  capabilities,  made  possible  by  the  National 
Advanced  Driving  Simulator  whose  development  has  recently  been  completed  by  the  US  Department  of 
Transportation  and  The  University  of  Iowa,  are  presented.  Highway  safety  research  and  vehicle  and  equipment 
design  applications  using  revolutionary  new  virtual  proving  grounds  are  reviewed  and  capabilities  of  the 
simulator  are  summarized.  Technological  developments  enabling  these  new  capabilities  are  presented,  including 
high  fidelity  real-time  dynamic  simulation  techniques,  computer  image  generation  enhancements,  precision 
motion  control  capabilities,  and  virtual  environment  modeling  tools. 

1.  Introduction 

Aircraft  flight  simulators  have  evolved  to  a  high  level  of  maturity  during  the  six  decades  since  E.  A.  Link 
invented  his  initial  flight  training  simulator  (Link,  1930).  While  flight  simulators  are  most  commonly  viewed  as 
training  tools,  significant  use  is  made  of  advanced  flight  simulators  in  the  process  of  aircraft  development. 

NASA  Vertical  Motion  Base  Flight  Simulator  The  most  advanced  flight  simulator  shown  in  the  left  of 
Fig.  1  is  the  Vertical  Motion  Simulator  (VMS)  operated  by  NASA,  at  its  Ames  facility  in  California.  This 
simulator  has  an  ideal  motion  envelope  for  flight;  namely  travels  of  60  feet  vertical,  40  feet  lateral,  and  6  feet 
longitudinal.  The  frequency  response  of  this  flight  simulator,  however,  is  far  lower  than  is  required  for  ground 
vehicle  simulation. 

Daimler-Chrysler  Driving  Simulator  The  previous  most  advanced  ground  vehicle  simulator  shown  in 
the  right  of  Fig.  1  is  operated  by  Daimler-Chrysler  in  Berlin,  Germany  (Drostol,  Panik,  1985;  Kading, 
Hoffmeyer,  1995).  The  motion  system  consists  of  a  six-degree-of-freedom  hexapod,  but  with  somewhat  lower 
frequency  response  characteristics  than  are  ideal  for  ground  vehicle  virtual  prototyping.  This  hexapod  is 
mounted  on  a  single-degree-of-freedom  lateral  track  that  moves  20  feet,  providing  one-dimensional  braking  or 
lane  change  acceleration  cues,  but  not  both  simultaneously. 


Figure  1  NASA  Vertical  Motion  Flight  Simulator  and 
Daimler-Chrysler  Driving  Simulator 

Army  Military  Vehicle  Simulators  The  US  Army  Tank-automotive  and  Armaments  Command 
(TACOM)  operates  a  family  of  military  vehicle  simulators  in  Warren,  Michigan,  with  motion  capabilities 
appropriate  for  harsh  off-road  military  vehicle  applications.  The  Turret  Motion  Base  Simulator  shown  in  the  left 
of  Fig.  2,  supports  hardware-in-the-loop  simulation  with  a  payload  of  25  tons.  Both  this  simulator  and  the  new 
Ride  Motion  Simulator  shown  in  the  right  of  Fig.  2  have  high  frequency  and  acceleration  capabilities  that  are 
beyond  the  capability  of  any  other  known  ground  vehicle  simulator. 
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Figure  2  Army  Military  Vehicle  Simulators 


National  Advanced  Driving  Simulator  The  National  Advanced  Driving  Simulator  (NADS) 
shown  in  the  left  of  Fig.  3,  with  a  view  over  the  shoulder  of  the  driver  in  the  right  of  Fig.  3,  is  by  far  the  most 
advanced  ground  vehicle  driving  simulator  ever  created.  It  embodies  advanced  technologies  described  in 
Section  2  and  creates  a  driving  environment  that  is  within  the  threshold  of  human  perception  for  most  cues.  It 
thus  creates  a  fundamentally  new  experimental  facility  for  driver-vehicle  interaction  research,  supporting  both 
highway  safety  and  vehicle  system  engineering  applications. 


Figure  3  National  Advanced  Driving  Simulator 


The  purpose  of  this  paper  is  to  outline  (1)  fundamentally  new  human-centered  research  that  is  enabled  by  the 
NADS  and  (2)  technological  developments  that  have  enabled  development  and  implementation  of  the  NADS, 
the  most  advanced  ground  vehicle  driving  simulator  ever  developed.  To  set  the  stage  for  presentation  of 
enabling  technologies,  experimental  capabilities  of  the  NADS  are  illustrated  through  description  of  typical 
experiments  being  carried  out  with  the  simulator. 

2.  The  National  Advanced  Driving  Simulator 

The  National  Highway  Traffic  Safety  Administration  of  the  US  Department  of  Transportation  and  The 
University  of  Iowa  have  created  the  NADS  to  enable  research  that  will  enhance  US  highway  safety  and  vehicle 
system  design  (Haug,  et.  al,  1990;  1995;  1998).  The  Department  of  Transportation  invested  approximately  $69 
million  in  development  of  the  NADS  system,  and  The  University  of  Iowa  provided  $11  million  in  software  and  a 
building  to  house  the  NADS.  Development  of  the  simulator  system  was  completed  in  early  2002,  and  the  NADS 
is  now  operational  on  The  University  of  Iowa's  Oakdale  campus.  It  is  being  used  for  both  highway  safety 
research  and  vehicle  system  engineering. 

The  goal  of  the  NADS  project  is  to  achieve  fundamental  improvements  in  highway  safety,  transportation 
efficiency,  and  effectiveness  of  US  vehicle  and  equipment  manufacturers.  Specific  objectives  of  the  project 
include  conduct  of  research  using  the  NADS  simulator  that  will  (1)  lead  to  safer  highways,  significantly  reducing 
the  number  of  crashes  on  US  highways  that  currently  lead  annually  to  approximately  42,000  lives  lost  and  a  cost 
of  $230  billion  and  (2)  enhance  vehicle  and  equipment  product  development  effectiveness  for  an  industrial  sector 
that  accounts  for  1 1  percent  of  US  Gross  Domestic  Product. 

In  a  related  development,  the  US  National  Science  Foundation  awarded  a  multi-university 
Industry/University  Cooperative  Research  Center  (I/UCRC)  for  Virtual  Proving  Ground  Simulation  to  the 
Universities  of  Iowa  and  Texas- Austin  in  1997.  The  goal  of  the  Center  during  its  first  five  years  of  operation 
was  to  create  a  virtual  proving  ground  capability  for  the  NADS,  in  order  to  support  advanced  vehicle 
engineering.  The  initial  proving  ground  capability  now  operating  with  the  NADS  was  created  during  the  period 
1987-2001 .  In  early  2002,  the  National  Science  Foundation  awarded  the  Center  a  second  five-year  grant  to  build 
upon  and  advance  the  proving  grounds,  carrying  out  advanced  vehicle  system  engineering  research  with 
industrial  and  government  sponsors.  The  universities  are  cooperating  with  the  National  Science  Foundation,  the 
Department  of  Defense,  and  industry  to  develop  advanced  virtual  proving  grounds  and  associated  simulation 
research  programs  using  the  NADS  that  will  lead  to  fundamental  advances  in  vehicle  and  equipment  product 
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development  effectiveness.  Strong  support  for  this  research  has  been  obtained  from  the  agricultural, 
construction,  and  off-road  military  vehicle  and  equipment  manufacturing  sectors. 


The  purpose  of  this  section  is  to  provide  a  concrete  definition  of  the  NADS  system,  including  simulation 
environments  that  are  available  to  researchers,  and  to  place  NADS  capabilities  in  context  with  existing  ground 
vehicle  driving  simulators.  The  NADS,  as  it  currently  exists  on  the  University  of  Iowa  campus,  is  shown  in  the 
left  of  Fig.  3.  The  NADS  contains  nine  advanced  technology  modules  that  interact  with  the  driver  to  create  a 
highly  realistic  simulated  driving  environment,  as  follows. 

Visual  System  A  revolutionary  new  Evans  &  Sutherland  Harmony  visual  system  provides  the  driver  with  a 
highly  realistic  360-degree  field  of  view,  similar  to  the  environment  shown  in  the  right  of  Fig.  3,  including  rear 
view  mirror  images.  The  visual  system  database  includes  a  full  range  of  current  and  new  highway  traffic  control 
devices  (signs  and  signals),  three-dimensional  objects  that  vehicles  encounter  (animals,  potholes,  concrete  joints, 
pillars),  high-density  multiple-lane  traffic  interacting  with  the  driver’s  vehicle,  common  intersection  types,  and 
roadway  weather  environments. 


Motion  System  The  motion  system  shown  in  the  left  of  Fig.  3  provides  the  largest  translational  motion 
envelope  ever  developed  for  a  driving  simulator  (64  feet  square).  It  also  provides  360-degree  horizontal  yaw,  as 
well  as  pitch,  roll,  and  high-frequency  cues  that  duplicate  vehicle  motion  cues  to  the  driver,  over  the  full  range  of 
driving  maneuvers. 

Control  Feel  System  Control  feel  systems  for  steering,  brakes,  clutch,  transmission,  and  throttle  provide  the 
driver  with  a  realistic  feel  of  the  road  and  vehicle  response  to  driver  inputs,  over  the  full  vehicle  maneuvering 
and  operating  range.  The  control  feel  system  is  capable  of  representing  control  characteristics  such  as  power 
steering,  existing  and  experimental  drivetrains,  anti-lock  braking  systems,  and  headway  control  systems. 


Audio  System  The  audio  system  provides  realistic  three-dimensional  sound  sources  that  are  coordinated 
with  other  sensory  systems.  The  audio  database  includes  sounds  emanating  from  current  and  new  design 
highway  surfaces,  contact  with  three-dimensional  objects  that  vehicles  encounter  (potholes,  concrete/tar  joints, 
etc.),  high-density  multiple-lane  traffic,  and  vehicle  operation  (engine,  brake,  wind  noise,  and  weather  effects). 

Vehicle  Dynamics  High  fidelity  vehicle  dynamics  software  provided  by  The  University  of  Iowa  accurately 
represents  vehicle  motions  and  control  feel  conditions  in  response  to  driver  control  actions,  road  surface 
conditions,  and  aerodynamic  disturbances.  Vehicle  dynamics  models  of  the  scope  shown  in  the  left  of  Fig.  4 
simulate  light  passenger  cars  and  trucks,  heavy  trucks  and  buses,  and  off-road  wheeled  and  tracked  vehicles. 
The  models  encompass  normal  driving  conditions  and  extreme  maneuvers  encountered  during  crash  avoidance 
situations,  including  spinout  and  incipient  rollover.  More  detail  is  provided  in  Section  4. 


Scenario  Authoring  The  NADS  scenario  control  and  authoring  module  developed  by  The  University  of 
Iowa  simulates,  in  real  time,  traffic  elements  such  as  passenger  cars,  motorcycles,  trucks,  buses,  rail-based 
vehicles  and  pedestrians,  each  with  autonomous,  reactive  behaviors  (see  illustration  on  right  of  Fig.  4). 
Specialized  runtime  agents  simulate  operation  of  traffic  control  devices,  weather  effects  including  wind  and  fog, 
and  ambient  traffic  around  the  simulator  driver.  A  suite  of  Windows  NT-hosted  graphical  tools  allows  rapid 
development  of  scenes  and  scenarios,  without  explicit  programming,  for  use  by  experimenters  to  develop  and 
test  scenarios  before  proceeding  to  the  NADS  facility. 
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Figure  4  Real-Time  Vehicle  Dynamics  and  Scenario  Authoring  Software 

Vehicle  Cab  System  Vehicle  cabs  in  which  the  driver  functions  consist  of  actual  vehicle  cabs,  configured  to 
fit  within  the  visual  dome  on  the  motion  system.  Four  cabs  were  initially  delivered  with  the  NADS  system, 
including  cabs  for  a  Chevrolet  Malibu,  Ford  Taurus,  Jeep  Cherokee,  and  class-8  Freightliner  truck.  The  cabs 
have  a  full  range  of  standard,  optional,  and  new  design  vehicle  instrumentation  interfaces.  Cabs  allow  rapid 
interchangeability,  in  order  to  meet  an  unprecedented  high  experimental  efficiency  during  NADS  operation. 

Computer  System  A  system  of  dozens  of  computers  control  all  aspects  of  NADS  operations.  Databases 
defining  vehicle  characteristics,  the  visual  driving  environment,  audio  characteristics  of  the  environment,  and 
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roadway  characteristics  that  influence  performance  of  the  vehicle  are  highly  integrated,  to  enable  the  researcher 
to  create  and  supervise  controlled  experiments. 

Simulation  Development  Module  A  NADS-like  simulator,  called  the  simulation  development  module  for 
off-line  development  of  experiments  and  virtual  environments,  contains  all  the  basic  elements  of  the  NADS 
except  motion.  This  very  capable  unit  operates  separately  from  the  motion-based  NADS  simulator,  thus 
enabling  experimenters  to  cost-effectively  preview  scenarios  and  drive  through  scenes  to  assure  themselves  that 
the  experiment  is  well  structured  before  carrying  out  experiments  on  the  full  NADS  system. 


3.  Nads-Based  Virtual  Proving  Ground  Experiments 

Since  its  initiation  of  operation  in  early  2002,  three  sets  of  experiments  have  been  carried  out  to  initiate 
highway  safety  and  virtual  proving  ground  engineering  applications.  The  first  set  of  experiments  involved 
verification  of  simulator  performance  in  highway  safety  crash  avoidance  limit  maneuvers;  i.e.,  spin-out  and 
related  vehicle  maneuvers  in  the  NADS  shown  in  Fig.  5  that  represent  extreme  limits  of  vehicle  performance 
with  interaction  of  the  driver.  Qualitatively  excellent  results  have  been  obtained,  correlating  well  with 
quantitative  measures  of  performance  of  the  vehicle.  These  results  provide  the  foundation  for  a  current  set  of 
highway  safety  experiments  being  carried  out  by  The  University  of  Iowa  for  the  U.S.  National  Highway  Traffic 
Safety  Administration. 


Figure  5  Highway  Safety  Crash  Avoidance  Limit  Maneuvers 

The  initial  virtual  proving  ground  experiment  involved  linking  the  NADS  shown  in  the  right  of  Fig.  6  with 
the  Army  Ride  Motion  Simulator  shown  in  the  left  of  Fig.  6,  to  demonstrate  the  feasibility  of  high  fidelity 
engineering  simulator  interaction,  coupled  with  computer-aided  engineering  design  change  analysis  and 
verification  with  the  driver  in  the  loop.  Army  and  NADS  test  drivers  operated  high  fidelity  simulated  vehicles 
on  a  simulated  Army  proving  ground,  including  the  capability  to  see  each  other's  vehicle  and  interact.  In 
addition  to  achieving  excellent  network-based  interaction  of  engineering  fidelity  simulations,  design 
characteristics  of  the  vehicle  functioning  in  the  Ride  Motion  Simulator  were  modified  in  a  CAE  environment  as 
the  simulations  occurred,  to  evaluate  the  driver's  interaction  with  nominal  and  modified  vehicle  designs.  Results 
indicate  the  feasibility  of  ( 1)  interactive  simulation  of  vehicle  designs  with  the  driver  in  the  loop,  and  (2)  greatly 
reducing  the  time  required  for  vehicle  system  development. 


Figure  6  Interactive  Simulation  with  Engineering  Fidelity  RMS  and  NADS 


A  second  virtual  proving  ground  experiment  that  was  carried  out  in  early  April,  2002,  focused  on  validation 
of  a  NADS-based  agricultural  virtual  proving  ground.  This  project,  carried  out  with  Deere  &  Co.,  involved  a 
John  Deere  tractor,  shown  in  the  upper  left  of  Fig.  7,  with  the  NADS  simulator  cab  shown  below  the  tractor.  The 
tractor  and  a  proving  ground  were  modeled  at  an  engineering  level  of  fidelity,  and  experiments  were  carried  out 
on  the  actual  proving  ground  shown  in  the  center  of  Fig.  7.  The  model  created  of  the  tractor  was  exercised,  with 


the  operator  in  the  loop,  on  the  simulated  proving  ground  in  the  NADS,  as  shown  in  the  right  of  Fig.  7.  Initial 
qualitative  and  quantitative  performance  analysis  indicates  that  an  adequate  level  of  correlation  exists  between 
die  actual  and  virtual  proving  ground  to  form  the  basis  for  equipment  design  and  evaluation  using  the  virtual 
proving  ground. 


Figure  7  Validation  of  NADS-Based  Agricultural  Proving  Ground  Simulation 


4.  Technologies  Enabling  Vehicle  Virtual  Proving  Grounds 

Technologies  that  enable  design-level-of-fidelity  virtual  proving  grounds  are  summarized  in  this  section. 
They  include  computational  methods  for  high  fidelity  dynamics  and  tire -road  surface/terrain  interaction, 
synthetic  environment  modeling  for  on-  and  off-road  simulation,  and  managing  databases  and  synthetic 
environment  modeling  tools. 

High  Fidelity  Dynamics 

Even  though  the  human  can  respond  cognitively  only  to  cues  in  a  frequency  range  up  to  2-5  Hz,  transient 
events  lead  to  the  requirement  that  actuators  and  controllers  with  which  the  driver  interacts  must  accurately 
predict  transient  dynamic  effects  at  high  frequency.  For  example,  large  transient  forces  that  can  arise  in 
operation  on  rutted  roads  require  high  frequency  compensation  in  the  steering  system,  in  order  to  avoid  serious 
problems  with  the  driver’s  ability  to  control  the  vehicle.  Such  control  systems  often  respond  with  transients 
involving  frequencies  up  to  100  Hz. 

Similarly,  anti-lock  brake  and  active  suspension  systems  experience  response  of  the  wheel  assembly  up  to  20 
g,  leading  to  transient  effects  requiring  controller  compensation  in  excess  of  80  Hz.  Even  though  hydraulic  pulse 
rates  in  anti-lock  brakes  are  typically  below  7  Hz,  the  reaction  times  of  controllers  and  actuators  are  typically 
below  20  milliseconds.  Since  such  components  interact  to  first  order  with  wheel  spin,  which  contains  stiff 
transients,  one  millisecond  or  less  numerical  integration  step  size  is  required  in  simulation  with  explicit 
numerical  integrators  to  predict  anti-lock  brake  subsystem  performance  that  influences  the  driver’s  ability  to 
control  the  vehicle.  This  translates  to  a  frequency  content  above  80  Hz.  Similarly  active  suspension  performance 
in  the  presence  of  potholes  and  short  wavelength  roadway  undulations  such  as  ramble  strips  requires  that 
frequencies  of  50  Hz  or  more  be  accounted  for  in  designing  the  control  system  to  maintain  vehicle  control  by  the 
driver. 

Automated  Highway  System  concepts  of  the  future  place  an  even  greater  demand  on  high  simulation  fidelity 
for  support  of  device  design  to  interact  effectively  with  the  driver.  The  automotive  design  industry  will  accept  a 
driving  simulator  for  use  in  subsystem  design  on  a  virtual  proving  ground  only  if  extremely  high  fidelity, 
equivalent  to  a  frequency  response  up  to  100  Hz,  is  accounted  for  in  subsystem  simulations. 

Real-Time  Modeling  And  Simulation  Methods  Innovative  vehicle  design  technologies  based  on  advanced 
control  algorithms  are  commonly  used  in  modem  vehicles  to  achieve  optimum  power  transfer  from  mechanical 
and  electromechanical  powertrains  through  the  wheels  to  the  road.  The  interaction  between  the  tires  and  the 
road  is  governed  by  multiple  sources  of  high  frequency  excitation  coming  from  roughness  of  the  road  profile, 
tire  flexible  modes  of  vibration,  and  powertrain  actuator  response.  In  order  to  resolve  this  high  frequency 
content,  high  fidelity  dynamic  algorithms,  coupled  with  modem  and  efficient  numerical  integration  techniques 
(Haug,  Deyo,  1991),  are  necessary  to  guarantee  the  stability  of  the  numerical  solution  used  to  predict  motion 
cues  for  the  driver  within  the  simulator  environment.  In  emerging  vehicle  subsystems  such  as  hybrid-electric 
powertrains,  the  vehicle  system  engineer  will  be  required  to  conduct  human  factors  and  engineering  based 
studies  on  the  interaction  of  such  subsystems  with  the  driver.  These  systems  are  very  demanding  in  terms  of  the 
numerical  approach  used  to  accurately  predict  their  transient  performance. 

For  the  foregoing  reasons,  advanced  dynamics  formulations  and  implicit  and  multirate  numerical  integration 
techniques  have  been  developed  and  tested  for  use  in  the  NADS.  Advanced  numerical  methods  presented  in  a 
Special  Session  of  the  1998  ASME  Design  Automation  Conference  (Serban,  Haug,  1998;  Solis,  Schwarz,  1998) 
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provide  some  of  the  capability  required  for  simulating  modem  high  frequency  vehicle  subsystems  for  design  in  a 
virtual  proving  ground. 

In  order  to  determine  what  vehicle  modeling  and  simulation  features  are  normally  used  by  vehicle 
manufacturers  during  analysis  and  design,  NADS  and  LMS  International  held  a  two-day  workshop  October  25 
and  26,  2001 .  During  this  workshop,  it  was  found  that  the  on-road  vehicle  developer  community  was  calling  for 
better  representation  and  integration  of  flexible  bodies  into  the  vehicle  models,  and  for  higher  fidelity  bushings, 
shock  absorbers,  and  tire  component  models.  Some  of  the  manufacturers  do  not  even  consider  vehicle  models 
without  bushings  for  their  dynamic  evaluations.  For  this  reason,  a  task  to  develop  numerical  techniques  to 
efficiently  deal  with  bushings  in  vehicle  simulation  was  started.  Implicit  integrators  with  exact  Jacobian 
matrices  for  bushing  elements  were  formulated  and  are  currently  being  implemented  to  address  the  real-time 
simulation  of  vehicle  models  containing  bushings.  Body  flexibility,  normally  left  for  nonreal-time  simulation 
analysis,  is  being  included  into  current  simulation  codes  at  NADS  to  allow  for  body  compliance  that  affects 
vehicle  performance  and  its  interaction  with  the  driver. 

Tire-Road/Soil  Interface  To  meet  virtual  proving  ground  goals  of  simulating  both  on-  and  off-road  vehicles 
at  a  design  level  of  fidelity,  a  capability  that  includes  not  only  driving  vehicles  over  hard  rigid  soils  but  also  over 
soft  deformable  soils  must  be  provided.  One  of  the  key  core  technology  developments  required  to  achieve  this 
capability  is  significantly  enhanced  tire/soil  interaction  modeling.  This  technology  requires  development  in 
three  main  thrusts;  (1)  flexible  tire-hard  soil  interaction,  (2)  rigid  tire-deformable  soil  interaction,  and  (3)  flexible 
tire-deformable  soil  interaction.  Focusing  the  technology  development  in  this  fashion  helps  identify  critical 
elements  during  vehicle  simulation  over  highways  and  compact  rural  roads,  mild  off-road  applications,  and 
severe  soft  terrain  off-road  applications. 

Within  thrust  (1),  kinematic  tire  information  calculated  by  the  multibody  dynamics  module  is  coupled  with 
terrain  profile  information  to  compute  forces  generated  at  the  tire-road  interface.  Longitudinal  and  lateral  forces 
at  the  tire-road  interface  are  computed  based  on  the  slip  developed  in  the  respective  directions.  Normal  forces 
are  computed  using  geometrical  information  that  is  given  in  terms  of  position  and  velocity  of  the  wheel  hub  and 
shape  of  the  terrain  profile  under  each  wheel,  and  combining  it  with  stiffness  and  damping  of  the  tire.  The 
approach  in  this  thrust  is  the  most  commonly  used  for  both  on  and  off-road  vehicle  simulation,  due  to  the  large 
percentage  of  applications  for  which  the  rigid  terrain  assumption  is  applicable.  Also,  it  involves  the  tire  but  not 
the  soil,  which  is  more  difficult  to  represent.  The  complexity  of  the  models  under  this  thrust  is  a  function  of  the 
amount  of  compliance  and  vibration  modes  in  the  tire.  Its  compliance  is  due  to  the  amount  of  deformation  and 
the  existence  of  vibration  modes  depends  on  the  size  and  type  of  tire. 

Figure  8  shows  three  contact  models  for  thrust  (1).  Single  point  contact  queries  the  terrain  at  the  point 
directly  below  the  wheel  attachment  point.  The  intersection  between  the  tire  profile  and  the  terrain  determines 
the  tire  deformation  length  that  is  used  to  compute  the  normal  force.  This  approach  is  widely  used  for  on-road 
flat  surfaces  but  is  not  recommended  for  off-road  applications. 


Figure  8  Wheel/Tire-Soil  Contact  Models 

The  distributed  contact  model,  queries  the  terrain  in  multiple  points  under  the  wheel  attachment  point  to 
determine  the  shape  of  the  contact.  An  averaging  technique  is  then  used  to  calculate  the  effective  contact  force 
between  the  tire  and  the  terrain.  The  number  of  segments  in  the  model  is  chosen  based  on  the  roughness  and 
spatial  frequency  of  the  terrain. 

The  2D  model  shown  in  the  left  of  Fig.  8  is  based  on  a  finite  element  representation  using  beam  elements  for 
both  radial  and  tangential  members.  This  model  allows  for  a  distributed  stiffness  parameter  representation  of  the 
tire  that  can  be  used  to  improve  the  single-parameter  model  used  in  the  two  previous  models.  It  also  includes  tire 
inertial  effects,  which  are  critical  for  many  applications. 

Thrust  (2)  concentrates  on  applications  for  which  tire  deformation  is  small  compared  to  soil  deformation. 
Analytical  soil  mechanics  equations  are  used  to  compute  tire  forces  due  to  deformation.  This  is  made  known  by 
the  simple  shape  of  the  undeformed  tire,  which  greatly  simplifies  the  calculation.  The  right  of  Fig.  8  shows  a 
schematic  of  a  rigid-wheel  on  deformable  terrain.  Variations  of  this  approach  include  the  addition  of  a  tire 
deformation  section  of  known  geometry.  This  known  shape  still  allows  for  the  integration  of  the  normal 
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pressure  exerted  by  the  soil  on  the  tire  using  analytical  expressions  and  provides  a  correction  for  tire  deformation 
that  extends  the  applicability  of  this  approach  to  relatively  harder  soils  or  tires  with  lower  pressures. 

Finally,  thrust  (3)  addresses  the  more  general  problem  of  deformable  tire  and  soil.  A  general  nonlinear  finite 
element  approach  is  applied  to  solve  for  forces  generated  within  the  tire-soil  interface  and  the  resulting  terrain 
profile  deformation,  as  shown  in  the  left  of  Fig.  9.  The  on-going  activity  to  develop  a  better  predicting  capability 
for  off-road  vehicle  simulation  is  targeting  the  soil  formulations  needed  in  the  finite  element  representation  for 
different  soil  types.  This  high-fidelity  model  is  being  used  to  improve  the  understanding  of  the  traction 
phenomena  and  to  develop  better  real-time  models.  This  thrust  also  supports  determining  the  trafficability  of 
off-road  vehicles  over  a  given  terrain. 


Figure  9  Flexible  Tire-Soil  Model  and  Integrated  High-Fidelity  Simulation  Environment 

Vehicle  System/Subsystem  Simulation  For  Design  Due  to  the  increasing  complexity  of  vehicle  and 
component  design,  as  well  as  the  nature  of  technologies  that  are  being  integrated  into  modem  vehicles,  the 
traditional  design  approach  that  depends  on  building  and  testing  many  physical  prototypes  is  not  a  cost  effective 
approach  for  vehicle  product  development.  The  simulation-based-design  approach  has  varying  degrees  of 
implementation  that  range  from  modeling  and  simulating  components,  such  as  antilock  brakes  and  headway 
control  devices,  to  modeling,  simulating,  and  integrating  an  entire  vehicle  system.  Depending  on  system 
complexity  and  size,  this  integrated  environment  requires  a  large  amount  of  computational  resources  to  produce 
a  solution  in  a  timely  manner.  Complete  vehicle  systems  are  now  being  used  to  reduce  the  number  of  physical 
tests  in  the  design  optimization  process.  In  off-road  applications,  recent  developments  in  tire-soil  modeling  and 
simulation  coupled  with  integrated  vehicle  simulation  environments  have  enabled  a  higher  degree  of  dynamic 
predictability  for  complete  vehicle  systems.  This  new  capability  is  being  used  with  good  results  on  rigid 
surfaces  but  further  development  is  necessary  to  incorporate  the  soil  compliance  more  effectively.  The  right  side 
of  Fig.  9  shows  a  settling  run  of  a  High  Mobility  Multipurpose  Wheeled  Vehicle  model  simulated  in  DADS, 
integrated  with  four  high-fidelity  tires  modeled  using  the  ABAQUS  software. 

Synthetic  Environments 

The  creation  of  realistic  synthetic  driving  environments  poses  many  challenges  (Cremer,  Kearney,  Papelis, 
1996).  In  particular,  driving  simulation  requires  scene  databases  of  large  geographic  regions  with  properly 
modeled  roads,  high-fidelity  terrain,  natural  foliage,  and  appropriate  cultural  features.  Because  of  the  nearness 
of  surroundings,  synthetic  driving  environments  must  be  modeled  at  a  much  higher  resolution  than  flight  terrain 
databases.  Synthetic  environments  must  also  support  the  creation  and  execution  of  scenarios  involving  vehicular 
and  pedestrian  traffic  that  meet  experimenter  requirements  (Cremer,  et  al.,  1994).  The  NADS  synthetic  driving 
environment  comprises  multiple  correlated  databases,  each  providing  data  about  the  same  synthetic  environment, 
but  in  views  that  are  specialized  to  the  interrogating  subsystem.  Specialized  views  are  provided  to  support  image 
generation,  autonomous  traffic  elements,  audio  cue  generation,  vibration  special  effects,  and  tire-road  interface. 

On-  and  off-road  applications  have  differing  database  requirements.  For  example,  road  surfaces  are  typically 
hard,  allowing  use  of  static  database  structures  for  roadway  networks.  In  contrast,  off-road  terrain  must  be  able 
to  support  real-time  terrain  updates  corresponding  to  tire  rut  generation  and  other  ground- vehicle  interactions. 
Furthermore,  road  surfaces  are  typically  much  smoother  and  more  well  defined  than  off-road  terrain.  This 
results  in  the  use  of  different  representations  for  on-  and  off-road  surfaces.  On-road  modeling  is  well  developed, 
building  directly  on  substantial  experience  gained  with  a  previous  generation  of  simulator.  Accurate  real-time 
modeling  of  dynamic  off-road  synthetic  environments  is  less  well  developed.  The  following  briefly  summarizes 
the  features  of  NADS  on-  and  off-road  synthetic  environments  being  created. 

On-Road  Synthetic  Environment  The  most  complex  view  of  the  NADS  synthetic  environment  database  is 
the  Virtual  Roadway  Environment  Database  (VRED),  which  contains  information  about  the  logical  and  physical 
layout  of  roadways  and  can  manage  real-time  interrogation  of  static  and  dynamic  objects.  Logical  roadway 
information  encompasses  enough  detail  to  support  navigation  and  conforming  to  traffic  rules.  It  includes  the 
number,  direction,  and  type  of  lanes,  including  standard,  automated  highway  systems,  and  high-occupancy 
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vehicles;  the  nature  of  lane  separators;  shoulder  information;  road  markers;  and  a  complete  intersection  model 
that  supports  an  arbitrary  number  of  incident  roads. 

The  physical  roadway  representation  incorporates  a  hybrid  model  that  uses  three-dimensional  splines  with 
two-dimensional  continuity  for  the  roadway  surfaces  and  a  uniform  grid  of  elevation  and  material  posts  used  for 
intersections,  special  effects,  and  other  non-standard  roadway  terrain.  Any  number  of  disjoint  elevation  grid 
maps  can  be  included  in  a  synthetic  environment,  and  they  can  overlap  the  splinar  representation.  Road  holes, 
seams,  or  other  localized  perturbations  can  be  modeled  using  overlapping  terrain.  The  splinar  representation 
utilizes  two  independent  splines,  one  for  the  longitudinal  roadway  axis  and  one  for  the  lateral  axis.  The  lateral 
spline  can  change  at  any  point  along  the  longitudinal  axis,  allowing  modeling  of  arbitrary  variations  in  road 
geometry.  To  support  real-time  interrogation  of  the  terrain  elevation  by  the  tire  module,  VRED  uses  specialized 
data  structures  that  utilize  two-dimensional  hashing  algorithms  to  quickly  access  the  spline  or  grid  parameters. 

Off-Road  Synthetic  Environment  The  terrain  database  component  of  the  NADS  synthetic  environment 
provides  a  high-resolution  representation  of  ground  surface  characteristics,  including  elevation,  surface  type, 
roughness,  and  friction,  for  both  on-road  and  off-road  applications.  Off-road  applications  involving  driving  over 
extended  regions  of  soft  soil  present  severe  modeling  challenges.  First,  the  drivable  area  that  must  be 
represented  at  high  resolution  generally  becomes  greater  when  vehicles  are  permitted  to  leave  the  confines  of 
well-defined  road  paths.  Second,  off-road  applications  involving  agricultural,  construction,  and  military  vehicles 
often  involve  dynamic  interaction  of  wheels  and  soft  soil,  thus  making  it  necessary  to  support  real-time  update  of 
the  terrain  database,  as  determined  by  the  tire-soil  interaction  subsystem.  Third,  some  applications  include 
significant  interactions  between  the  ground  and  parts  of  the  vehicle  other  than  the  tires,  such  as  when  rocks  or 
bumps  impact  the  vehicle  undercarriage.  Thus,  off-road  synthetic  environments  must  support  detection  and 
characterization  of  geometric  contact  between  vehicles  and  the  ground  and  other  objects. 

These  requirements  make  real-time  modeling  of  off-road  environments  a  considerable  challenge.  It  is  not 
feasible,  for  visual  display  purposes,  to  represent  the  entire  database  at  the  highest  required  resolution. 
Researchers  are  developing  dynamic  terrain  modeling  techniques  based  on  variable  resolution  meshes  that  may 
be  updated  in  real  time  as  terrain  updates  are  computed.  The  techniques  being  developed  require  tight 
integration  of  the  terrain  and  visual  databases,  in  order  to  achieve  real-time  display  of  terrain  updates  at 
appropriate  fidelity. 


Management  Of  The  Synthetic  Environment  An  arbitrary  number  of  static  and  dynamic  objects  are 
managed  in  real  time  within  the  synthetic  simulator  environment  (see  the  right  side  of  Fig.  4).  Static  objects  that 
are  used  to  model  traffic  signs,  poles,  vegetation,  structures,  or  any  other  necessary  obstruction  can  be  associated 
with  a  particular  location  on  a  road,  or  on  off-road  terrain.  Dynamic  objects  represent  participants  that  can  move 
freely.  VRED  is  responsible  for  storing  the  state  of  moving  objects  and  providing,  in  real  time,  information 
about  their  location  with  respect  to  a  specialized  network  coordinate  system.  For  on-road  applications,  this 
coordinate  system  utilizes  the  road,  lane,  and  parameterized  distance  along  a  road  as  the  three  coordinates  for 
locating  objects  in  space.  Autonomous  object  behaviors  use  this  coordinate  system,  because  it  is  much  simpler 
(and  computationally  cheaper)  to  compare  the  relative  position  of  vehicles  along  a  roadway  by  using  the 
parameterized  distance,  as  opposed  to  using  vector-based  methods.  For  off-road  applications,  the  situation  is 
more  complex  and  remains  to  be  investigated. 


Authoring  Synthetic  Environments  The  creation  of  synthetic  on-road  driving  environments  containing 
road  networks  that  are  consistent  with  civil  engineering  standards  is  a  difficult  process  that  requirs  substantial 
effort  by  scene  database  specialists.  Researchers  are  developing  tools  to  support  rapid  construction, 
modification,  refinement,  and  debugging  of  scene  databases. 


5.  Conclusions 

High-fidelity  real-time  simulation  capabilities  and  emerging  ground  vehicle  driving  simulators  outlined  in 
this  paper  provide  the  foundation  for  vehicle  subsystem  and  system  virtual  proving  grounds,  at  a  design  level  of 
fidelity.  Together  with  the  virtual  proving  ground  simulation  capability  enabled  very  recently  by  the  National 
Advanced  Driving  Simulator  for  real-time  interaction  of  the  vehicle  and  driver,  a  revolutionary  new  environment 
is  now  available  for  designing  and  testing  vehicle  subsystems  and  components.  Realistic  load  histories  obtained 
from  vehicle  system  virtual  proving  ground  simulations  can  now  be  used  to  design  and  test  component  hardware 
in  the  laboratory.  This  new  capability  serves  two  purposes;  (1)  it  improves  component  design  and  testing  by 
generating  realistic  duty  cycle  information  early  in  the  design  cycle,  and  (2)  it  provides  hardware  measurements 
to  validate  on-line  models  to  improve  overall  simulation  accuracy  and  realism. 
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Abstract 

In  this  paper,  a  real-time  multibody  vehicle  dynamics  and  control  model  has  been  developed 
for  a  PC  based  low  cost  virtual  reality  vehicle  simulator  in  the  application  to  ACC  (Adaptive 
Cruise  Control).  The  model  consists  of  a  scenario  module  for  preceding  vehicle  motions,  a 
control  module  including  an  ACC  logic  based  on  sliding  mode  control,  and  a  throttle/brake 
switching  logic,  and  a  real-time  multibody  vehicle  dynamics  module  based  on  the  subsystem 
synthesis  method.  For  a  virtual  environment  implementation,  a  graphic  modeling  tool,  3D 
Studio  Max,  and  a  real-time  rendering  tool  OpenGVS  are  used.  To  verify  the  effectiveness 
of  the  developed  model,  typical  ACC  simulations  such  as  cut-out,  cut-in,  stop-and-go  have 
been  carried  out. 

1.  Introduction 

The  concept  of  the  ACC  system  is  shown  in  Fig.  1 .  ACC  system  controls  the  throttle  valve 
and  the  brake  master  cylinder  to  maintain  a  desired  space  between  the  preceding  vehicle  and 
the  ACC  vehicle.  To  evaluate  performance  of  the  ACC  system  and  driver’s  response  to  the 
intelligent  vehicles,  a  vehicle  simulator  with  a  virtual  reality  feature  can  be  a  very  effective 
tool.  For  such  a  vehicle  simulator,  a  real-time  vehicle  dynamics  and  control  model  is 
essential. 

The  purpose  of  this  paper  is  to  propose  a  real-time  integrated  vehicle  dynamics  and 
control  model  for  a  virtual  reality  vehicle  simulator,  especially  in  the  application  to  ACC 
simulations. 


Preceding  ACC 

Vehicle  Vehicle 


Figure  1.  ACC  Concept 


2.  Real-time  Multibody  Vehicle  Dynamics  and  Control  Model 

The  computational  model  for  real-time  vehicle  dynamics  and  control  consists  of  three 
modules,  i.e.,  a  preceding  vehicle  movement  scenario  module,  a  control  module  that  includes 
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the  ACC  logic  and  the  throttle  and  brake  switching  logic,  and  a  real-time  multibody  vehicle 
dynamics  module.  The  preceding  vehicle  movement  scenario  module  generates  the 
preceding  vehicle  motion  for  the  control  module.  With  the  preceding  vehicle  motion  and  the 
ACC  vehicle  states  from  the  vehicle  dynamics  module,  the  control  module  computes  required 
throttle  angles  and  brake  angles  for  the  real-time  vehicle  dynamics  module. 


2.1.  REAL-TIME  MULTIBODY  VEHICLE  DYNAMICS  MODEL 

The  vehicle  model  used  in  this  paper  is  HMMWV  (High  Mobility  Multipurpose  Wheeled 
Vehicle)  [1].  HMMWV  model  consists  of  4  independent  SLA  (Short-Long  Arm)  suspension 
subsystems,  a  power-train  subsystem,  STI  tire  subsystem  [2],  a  rack  and  pinion  steering 
subsystem,  a  brake  subsystem,  and  a  real-time  multibody  vehicle  dynamics  equation 
generator  that  is  based  on  the  subsystem  synthesis  method  [3].  To  use  the  subsystem  synthesis 
method,  the  vehicle  model  is  decomposed  into  4  suspension  subsystems  and  a  chassis  as 
shown  in  Fig.  2.  For  each  suspension  subsystem,  the  closed  loop  subsystem  equations  of 
motion  can  be  obtained  using  the  recursive  formulation  in  multibody  dynamics. 
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For  the  chassis,  6x6  matrix  form  of  equations  of  motion  can  be  expressed  as  follows; 

(m0+Xm,)y0  =  (Qo+Zp,)  & 

/=l  i=l 

where  M,and  P.  (i=l~4)  are  the  effective  inertia  matrix  and  the  effective  force  vector  of 

each  subsystem,  respectively  [3].  In  the  subsystem  synthesis  method,  6x6  matrix  form  of 
chassis  equations  of  motion,  as  shown  in  Eq.  2,  is  first  solved.  Then,  for  each  suspension 
subsystem,  equations  shown  in  Eq.  1  are  solved  for  suspension  acceleration.  Since  several 
small  size  equations  of  motion  are  solved  instead  of  solving  large  size  equations,  the 
subsystem  synthesis  method  provides  computational  efficiency. 


2.2.  ACC  CONTROL  MODEL 

Fig.  3  shows  the  computational  flow  in  the  control  module.  Sliding  mode  control  is  used  to 
design  a  spacing  controller  for  ACC  [4].  According  to  relative  distance  between  the 
preceding  vehicle  and  the  ACC  vehicle,  the  required  engine  or  brake  torque  is  calculated. 
Using  throttle  and  brake  switching  logic,  either  throttle  or  brake  control  is  determined  [5]. 
In  the  throttle  control,  inverse  torque  map  is  used  to  compute  the  desired  throttle  pedal  angle. 
In  the  brake  control,  necessary  torque  and  the  corresponding  desired  brake  pedal  angle  are 
computed.  These  pedal  angles  are  the  inputs  of  real-time  multibody  vehicle  dynamics  model. 
In  this  control  model,  the  headway  time  control  strategy  is  utilized  to  design  the  desired 
relative  distance.  The  head  way  time  is  defined  as  the  time  that  the  ACC  vehicle  collides  with 
the  preceding  vehicle,  when  the  preceding  vehicle  stops  immediately.  According  to  the 
headway  time  strategy,  the  desired  vehicle  spacing,  xrdes  is  obtained  from 

Xr_des=Vf-h  (3) 

where  Vf  is  the  following  ACC  vehicle  speed,  and  th  is  headway  time.  The  desired  acceleration 
is  also  obtained  as  [4]; 
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(4) 


vr-ASat(~) 

a  = _ 0_ 

“f-des 

lh 

where  vr  is  the  relative  velocity,  A  is  a  positive  gain,  Sat(.)  is  the  saturation  function,  s  is  the 
sliding  surface  defined  as  s  =  xrdes-xr,  and  O  is  the  boundary  layer  thickness.  The 
saturation  function  is  used  to  have  better  riding  quality  by  preventing  wild  throttle  movement. 
In  order  to  prohibit  jerking  motion  of  the  ACC  vehicle,  the  desired  acceleration  af  des  is 
bounded  between  lm/s2  and  -2.5m/s2. 
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Figure  2.  Topology  of  vehicle  model 
with  subsystems 


Figure  3.  Control  module  flow  chart 


The  desired  engine  torque  corresponding  to  the  desired  acceleration  in  Eq.  4  can  be  obtained 
using  simplified  vehicle  equations  of  motion  and  the  simple  engine  model  [4]. 


1  eng  _  des 


»  y  •  r 
drive  gear 


■)+  Hr'rdnVc-rgcaAFa+  Fr))/\ 


where  Hr  is  the  tire  radius,  rdrjVe  is  final  drive  gear  ratio,  rgear  is  current  gear  ratio,  rtq  is  the 
torque  ratio  in  the  torque  converter,  Jefr  is  the  effective  total  inertia  from  the  engine,  Fr  is 
rolling  resistance  and  Fa  is  aerodynamic  drag. 

After  obtaining  the  desired  engine  torque,  throttle  and  brake  switching  logic  is  applied  to 
determine  whether  engine  braking  or  active  braking  is  necessary.  If  the  amount  of  the 
desired  torque  is  smaller  than  that  of  the  torque  generated  from  engine  brake,  then  active 
braking  is  applied.  Once  engine  braking  or  active  braking  is  determined,  the  desired  throttle 
angle,  ades ,  is  obtained  from  the  inverse  engine  performance  map. 

<xdes=T-'eng(a),Teng  des)  (6) 

For  active  braking,  the  necessary  brake  torque  is  computed  in  Eq.  7  and  the  brake  pedal  angle 
can  be  obtained  from  the  linear  relationship  between  the  braking  torque  and  pedal  angles. 

T  -T 

HT  _  net  net  _des 

lb  des  (7) 

~  r  *  r 

drive  gear 

where  Tb_des  is  the  necessary  braking  torque,  Tnet  des  is  the  desired  torque  to  maintain  desired 
relative  distance  and  Tnet  is  the  engine  brake  torque  that  is  generated  with  zero  throttle  angle 
in  the  current  engine  speed. 


3.  A  Low  Cost  Virtual  Reality  Vehicle  Simulator 
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A  PC  based  low  cost  virtual  reality  vehicle  simulator  is  shown  in  Fig.  4.  The  simulator 
consists  of  two  PCs  (one  for  real-time  vehicle  dynamics  and  control,  and  the  other  for  real¬ 
time  graphic  rendering),  a  visualization  system  such  as  a  beam  projector,  and  a  vehicle 
cockpit.  Two  PCs  are  networked  using  TCP/IP.  Every  40mili-seconds,  vehicle  states  are 
transferred  to  the  graphic  PC  to  generate  25  ffame/s  display  rate. 

To  generate  virtual  reality  environment,  a  graphic  modeler  3D  Studio  Max,  a  real-time 
rendering  scene  generator  OpenGVS  have  been  employed.  Fig.  5  shows  the  virtual 
environment  for  ACC  simulations. 


Figure  4.  A  low  cost  vehicle  simulator  Figure  5.  Virtual  reality  graphic  scene 


4.  ACC  Simulations 


In  order  to  verify  the  developed  multibody  vehicle  dynamics  and  control  model,  typical 
simulations  for  the  ACC  vehicle  have  been  carried  out;  i.e.,  stop-and-go,  cut-in,  and  cut-out 
simulations.  Fig.  6  shows  the  results  of  stop-and-go  simulations.  In  this  simulation,  the 
preceding  vehicle  makes  a  complete  stop  and  then  restarts.  The  first  figure  of  Fig.  6  shows 
that  the  ACC  vehicle  properly  follows  the  preceding  vehicle.  The  second  figure  of  Fig.  6 
shows  the  acceleration  and  brake  pedal  angles.  It  shows  that  the  switching  logic  in  ACC  is 
properly  working. 


Tune  vs  Velocity 


Figure  6.  Stop-and-go  Simulation 


Cut-out  simulations  have  been  also  carried  out  as  shown  in  Fig.  7.  In  the  cut-out 
situation,  two  preceding  vehicles  run  ahead  of  the  ACC  vehicle.  The  second  vehicle  (V2), 
which  is  just  in  front  of  the  ACC  vehicle,  changes  lane.  Thus,  the  ACC  vehicle  suddenly  has 
to  follow  the  first  vehicle  (VI).  In  this  case,  the  ACC  vehicle  experiences  sudden  changes  in 
the  relative  position  and  the  relative  velocity  between  the  ACC  and  the  preceding  vehicles. 
The  first  figure  of  Fig.  7  shows  the  velocities  of  the  preceding  vehicles  and  the  ACC  vehicle. 
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After  the  lane  change  occurs,  the  ACC  vehicle  accelerates  itself  to  and  then  keeps  the  constant 
velocity  that  is  larger  than  that  of  the  preceding  vehicle  (VI)  to  maintain  the  desired  distance. 
The  second  figure  of  Fig.  7  shows  the  relative  distance  between  the  preceding  and  the  ACC 
vehicles.  The  ACC  vehicle  gradually  recovers  the  desired  distances. 


T*""  (»*c)  TVn#  (ik| 


Figure  7.  Cut-out  simulation 

Cut-in  simulations  have  been  also  carried  out.  In  this  situation,  during  the  ACC  vehicle 
follows  the  preceding  vehicle  with  constant  speed,  the  other  vehicle  with  the  same  speed  in 
the  next  lane  abruptly  cuts  in  between  the  preceding  and  the  ACC  vehicles.  The  first  figure 
of  Fig.  8  shows  the  velocities  of  the  ACC  vehicle.  After  cut-in  occurs,  the  ACC  vehicle  slows 
down  a  little  bit.  The  second  figure  of  Fig.  8  shows  the  relative  distance  between  the 
preceding  and  the  ACC  vehicles.  Due  to  cut-in  at  50  sec.,  the  relative  distance  is  suddenly 
reduced.  According  to  the  headway  time  strategy,  relative  distance  is  increased  back  to  the 
original  distance  within  10  seconds. 


Tlm«  v«.  Velocity  Tima  vr  Pos'lon  dlfwarc* 


Figure  8.  Cut-in  simulation 


To  see  the  real-time  capability  of  the  developed  model,  CPU  time  has  been  measured  in 
Pentium  IV  1.6  Ghz  CPU  with  RAM  256  Mb.  For  120  second  overall  simulation  time,  5.23 
seconds  computational  CPU  time  has  been  measured.  For  numerical  integration,  Adams 
Bashforth  3rd  order  formula  is  used  with  8  ms  integration  step  size.  This  proves  the  developed 
model  indeed  has  a  real-time  simulation  capability. 
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5.  Conclusions 


A  real-time  multibody  vehicle  dynamics  and  control  model  has  been  developed  for  a  low  cost 
virtual  reality  ACC  vehicle  simulator.  Subsystem  synthesis  method  is  employed  to  generate 
efficient  multibody  vehicle  equations  of  motion.  The  sliding  mode  control  and  throttle/brake 
switching  logic  are  used  for  the  ACC.  Several  simulations  such  as  stop-and-go,  cut-in,  and 
cut-out,  show  that  the  developed  model  is  suitable  for  ACC  simulations.  The  CPU  time 
measure  proves  the  real-time  capability  of  the  proposed  model. 
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ABSTRACT 

The  dynamic  behavior  of  a  flexible  beam  that  is 
pulled  into  and  drawn  out  of  a  gap  in  an  elastic  wall  with 
a  constant  velocity  is  studied  using  a  mechanical  model 
and  experiments.  We  focus  particularly  on  the  effects  of 
the  guide  in  front  of  the  inlet  of  the  gap  and  the  fluid 
force  on  these  behaviors.  Our  simulation  model  is 
verified  to  simulate  well  the  behavior  of  beam  when  the 
guide  is  provided  in  front  of  the  inlet.  In  the  case  of  the 
drawing  out  the  beam,  we  found  out  that  the  fluid  force 
works  to  be  the  beam  destabilized,  and  the  divergence 
type  instability  phenomena  is  caused  in  the  beam  due  to 
the  fluid  force  when  the  driving  velocity  is  high  and  the 
density  of  the  fluid  is  also  high  through  numerical 
simulations. 

1.  INTRODUCTION 

We  all  know  that  if  we  rapidly  snuck  a  spaghetti 
noodle  into  our  mouth,  the  end  tip  of  it  comes  to  vibrate 
in  amplitude  more  heavily  as  the  length  of  free  end 
becomes  shorter.  This  phenomenon  is  called  the 
Spaghetti  Problem  [1],  A  similar  phenomenon  is 
observed  in  mechanical  systems  when  a  flexible  beam  or 
plate  is  pulled  axially  into  a  gap  in  a  wall  with  a  large 
driving  velocity,  as  displayed  by  several  industrial 
machines;  e.g'.,  machines  that  coil  thin  steel  plate,  the 
space  satellite  dynamics  related  to  extend  its  antenna  [2], 
and  flexible  extensile  robot  arms  [3  ] . 

When  it  is  drawn  axially  out  from  a  gap  in  a  wall,  the 
divergence  type  instability  due  to  the  fluid  force,  namely, 
the  Reverse  Spaghetti  Problem  is  observed;  e.g.’ 
apparatus  that  ejects  paper  sheets  such  as  high  speed 
printing  and  copy  machines  [4,5], 

A  great  interest  in  vibration  and  instability 
mechanism  has  aroused  to  not  only  industrial  but  also 
scientific  problem.  Analyses  of  such  systems  have  been 
carried  out  with  models  as  employing  boundary 
conditions  and  a  vibrating  body  of  time-independent 
length.  Stylianou  and  Tabarrok  have  done  the  analysis 
using  a  time  varying  shape  function  [6],  Vu-Quoc  and  Li 
presented  the  analysis  using  Lagrangian  formulation  and 


Galerkin  method  for  accounting  the  large  deformation 
and  overall  motion  [7], 

However,  the  mechanism  by  which  the  lateral 
vibration  increases  rapidly  with  large  deflection  and  a 
large  driving  velocity  has  not  been  examined  sufficiently. 
Moreover,  fluid  force  interaction  due  to  the  motion  of  the 
axially  moving  body  also  has  not  been  considered  in 
these  studies,  though  this  effect  come  to  significant  in 
actual  machine  operating  with  a  large  driving  velocity  in 
air  and  fluid  environment. 

One  of  present  authors  hypothesized  that  the 
elasticity  of  the  inlet  of  the  wall  gap  has  a  significant 
effect  on  the  behavior  in  the  Spaghetti  Problem,  and  of 
these  presented  two  kinds  of  modeling  methodologies  for 
this  problem  [8].  One  of  these  models  is  based  on  a 
developed  finite  clement  formulation  and  the  other  is 
based  on  the  finite  segment  method.  We  demonstrated 
that  these  models  provide  a  good  description  of  the 
Spaghetti  Problem  from  the  results  of  numerical 
simulations  and  experiments  [9]. 

This  paper  presents  two  topics.  One  is  the  effect  of  a 
tapered  guide  in  front  of  the  inlet  of  the  wall  gap  on  the 
Spaghetti  Problem.  We  developed  our  finite-segment- 
based  Spaghetti  model  in  the  case  that  the  tapered  guide 
is  provided  in  front  of  the  inlet  of  the  wall  gap.  Effects  of 
the  taper  angle  and  the  pulling  velocity  on  the  spaghetti 
behavior  are  discussed  with  experimental  and  numerical 
investigations.  The  other  is  the  effect  of  the  fluid  force  on 
the  Reverse  Spaghetti  Problem.  We  introduce  the  fluid 
force  that  is  derived  from  the  complex  velocity  potential 
flow  on  our  model.  Especially,  stability  and  the 
divergence  type  instability  phenomena  are  discussed. 

2.  MODELING  OF  SPAGHETTI 
2.1  Mechanical  model 

Figure  1  describes  the  mechanical  model  of  the 
Spaghetti  Problem  with  the  tapered  guides  that  is  evolved 
out  of  the  model  by  the  authors  [8].  A  flexible  beam  of 
length  L  and  thickness  t  is  divided  into  nb  rigid  bodies 
which  are  connected  by  hinged  joints.  Rotational  springs 
denoted  k+  which  represent  the  bending  stiffness  of  the 
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beam,  are  located  at  the  joints.  The  reaction  forces  from 
the  elastic  wall  gap  and  the  tapered  guide  are  modeled 
with  hard  springs  and  dampers.  The  flexible  beam  is 
pulled  into  or  drawn  out  from  the  elastic  wall  gap  with  a 
certain  velocity  V. 

We  fix  the  origin  of  the  global  coordinate  system  O- 
XY  at  the  inlet  of  the  gap  and  the  origin  of  die  body 
coordinate  system  orxy,  of  the  i-th  body  at  the  center  of 
gravity  of  the  body.  The  length,  mass  and  moment  of 
inertia  of  the  i-th  body  are  2 /,,  m,  and  J„  respectively.  We 
choose  generalized  coordinate  q  to  represent  the  center 
of  gravity  and  the  attitude  of  all  bodies: 
q  =  {x,  y,  <j\  x2  y2  <j>2 . x,  y f  <p, . xnh  ynb  . (1). 


2.2  Reaction  from  wall  gap  and  tapered  guide 

In  the  case  that  there  is  a  finite  clearance  between  the 
beam  and  the  elastic  wall  gap  as  shown  Figl,  the  beam  is 
pulled  into  the  gap  while  undergoing  reaction  force  and 
friction  force  exerted  by  the  elastic  wall  at  the  time  that 
the  beam  contacts  the  wall.  We  define  the  clearance  Cp 
between  the  beam  and  the  side  of  the  wall  gap  as  the  sum 
of  the  upper  clearance  c„  and  lower  clearance  c/. 

At  the  time  that  the  beam  is  pulled  into  the  gap  with 
elastic  deformation,  the  attitude  of  body  i  of  the  beam  at 
the  inlet  of  the  gap  is  illustrated  in  Fig. 2  (a). 

The  body  i  experiences  reaction  forces  exerted  by 
the  side  of  the  elastic  wall  gap  when  the  body  contacts 
them.  We  define  two  kinds  of  reaction  forces,  Fj  and  F2, 
representing  the  spring  force  and  damper  force.  Ft  is  the 
reaction  force  exerted  by  the  side  of  the  wall  gap  that  is 
determined  by  k,  and  c,.  The  direction  of  Fj  always 
coincides  the  global  F-axis.  F2  is  the  reaction  force 
exerted  by  the  inlet  of  the  wall  gap,  and  is  determined  by 
k2  and  c2.  The  direction  of  F2  varies  as  the  attitude  of 
body  i  changes. 

As  the  X  component  of  elastic  deformation  at  the 
contact  point  of  gap,  AX,,  is  very  small  in  the  case  that 
the  stiffness  of  the  wall  is  sufficiently  large,  the  X  and  Y 
directional  components  of  the  deformation  of  the  upper 
side  of  the  gap  are  given  as 
A*,  =0 

AF,  =  (y,  +/sin^.)-c„  if  AY,  <  0,  AY,  =  0 


The  X  and  Y  directional  components  of  elastic 
deformation  at  the  upper  inlet  of  the  gap  can  be  obtained 
from  the  geometrical  relationship  between  the  body  and 
the  upper  inlet  as 


AX2=(yJ-cu)sm2<fii/2  1 

AFj  ={yd~  c„XC0S  2<f>,  +  l)/2j 


for  yd — c«  -  O) 


AX2  =  AY2  =  0  for  yd  <  c„  . (4) 

where,  yd  is  the  Y  coordinate  at  the  intersection  of  the  Y 
axis  and  the  x,  axis  attached  to  body  i: 

yd  ~  Yi  ~  xi  tan  <!>,  . (5). 

The  body  i  experiences  reaction  forces  by  the  guide 


Fig.l  Mechanical  model  with  guide 


(a)  Reaction  force  exerted  (b)  Reaction  force  exerted 
by  elastic  wall  by  tapered  guide 

Fig.2  Kinematical  configuration  between  beam  and  wall 


at  the  time  that  the  beam  contacts  it  of  the  X  directional 
length  xe  and  the  taper  angle  a„  as  illustrated  in  Fig.2  (b). 
We  define  two  reaction  forces,  F3  and  F4,  representing  the 
spring  force  and  damper  force.  F3  is  the  reaction  force 
exerted  by  the  side  of  the  tapered  guide  that  is  determined 
by  k2  and  c3.  F4  is  that  exerted  by  the  edge  of  the  tapered 
guide.  It  is  determined  by  k4  and  c4. 

The  X and  Y  components  of  elastic  deformation  at  the 
upper  guide  can  be  obtained  from  the  geometrical 
relationship  between  the  body  and  the  upper  inlet  as 

AX3=(yc3 -y,) sin$cos$  ~(xc3  -x.-lsin^ 

AF3  =-Oc3  -y,)cosV  +  (*c3  -*,-)sin$cos$ 
where,  xc3  and  yc3  are  X  and  Y  coordinate  of  the  contact 
point  of  the  guide,  xlip  and  ylip  are  those  of  the  right  hand 
side  end  of  the  body  contacted  with  the  guide.  The 
relations  of  them  are  determined  as 
an^,. 

c3  1  +  tana,  tan^  . 

_  ix,,P  +y,ip  tan#)  tan  a,  +c„ 

^cl  1  +  tan  a,  tan  <f>, 

The  elastic  deformation  at  the  edge  of  the  tapered 
guide,  AX4  and  AY4  are  given  by  substituting  the 
coordinate  of  the  edge  (xe,  ye)  into  (xc3,  yci)  of  Eq.  (6). 
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Those  of  the  lower  side  of  the  gap  are  obtained  by 
simply  substituting  ct  for  c„  in  previous  equations.. 

The  components  of  the  reaction  forces  F|,  F2,  F3  and 
F<  exerted  by  the  elastic  wall  and  guide  are  obtained  as 


Fmx=-kmWm~cmL *m) 
Fv=-kmAYm-cm/LYm  J 


(8) 


where  m- 1  to  4  correspond  to  F,  to  F„,  respectively. 

The  generalized  force  "Q,,,  which  is  derived  from  the 
reaction  force  and  its  moment  exerted  by  the  elastic  wall 
and  guide,  can  be  obtained  as 


"Q,.  =  {”&  mQiy  "Qj 

=  Kr  Fmy  lm (fmy  cos  <pt  -  /^  sin  )}r 


(9). 


The  quantities  km  and  cm  represent  spring  constants 
and  damping  coefficients  of  the  elastic  wall  and  guide, 
respectively.  lm  is  the  distance  from  the  origin  of  the 
body  coordinates  to  the  line  of  action  of  the  reaction 
force,  and  is  obtained  from  geometrical  relations  as 


/2  =-/  +  (/ cos  (Z5-X,), 
h  =  iye-y) sin  i>,  +  {xt  -  x:  )cos  tf>. 


(10). 


The  friction  force  "Qlc  between  the  beam  and  the 
wall  and  guide  is  given  with  friction  coefficient  /y  as 


’Q,4aU  of  . (ii). 


From  Eqs.(9)  and  (11),  the  generalized  force 
associated  with  the  contact  force  mQ,  can  be  written  as 


"Q1=nQ,„+"Qif  . (12). 

The  generalized  force  Q17,-  which  work  on  body  i  are 
the  gravitational  force,  the  rotational  spring  and  damper 
force  due  to  the  bending  stiffness  of  the  beam. 

Qf  =  {°  -m,g 


2.3  Fluid  force  on  bodies 

We  derive  the  fluid  force  acting  on  the  bodies  from 
the  discrete  vortex  method  and  Blasius  Theorem,  which 
is  a  kind  of  the  numerical  method  for  the  complex 
velocity  potential  flow.  We  thought  this  method  is 
adequate  for  estimating  the  fluid  force  in  the  case  that  the 
boundary  layer  is  sufficiently  small. 

Figure  3  illustrates  vortexes  and  reference  points  we 
put  on  the  discretized  beam.  Small  circles  indicate 
vortexes  and  large  circles  indicate  reference  points  that  is 
placed  the  midpoint  of  adjoined  vortexes.  We  put  nc 
vortexes  with  regular  intervals  on  the  each  discritized 
beam  then  total  number  of  vortexes  on  the  beam  is 
nc*nb+ 1  =«v4-l.  We  also  define  ;(_/=  1, ...,  nv+1)  as 

the  circulation  of  the  vortex  located  at  z  tvW. 

The  induced  velocity  of  the  flow  at  the  )t-th  reference 
point  z£k)  on  the  body  surface  urk ;( k  =  1 , . . .,  nv)  is 


given  by  combination  of  the  steady  velocity  U  and  the 
fluid  velocity  associated  with  circulations  of  vortexes  as, 

:  nv*\  p 

=  {7-  — Y — -i*°>  . (14). 


2?r  n  zk») 


-z 


Ky> 


As  the  fluid  flows  along  the  body  surface,  the  normal 
component  of  urk  relative  to  the  body  surface  must  be 
coincident  with  the  moving  velocity  of  the  body  for 
inviscid  flow.  This  gives  the  following  boundary 
condition  for  the  £-th  reference  point  as, 

Ref“r*-"J=Re[^  •",*]  . (15). 

where  VH  is  the  moving  velocity  of  the  body.  The  unit 
normal  vector  on  the  Xr-th  reference  point  the  beam 
surface  nrk  is  given  as 

nit  ~  ~(24v(l-tl)  ~Z4r(t))/  .  (16). 

Substituting  Eqs  (14)  and  (16)  into  Eq.(15),  we  obtain 
the  following  relation 


-bk 

where 


(17), 


atJ  =  Re 

♦ 

1 

N 

o- 

_ 1 

2r(»)  2b,{j) 

(18). 


The  circulation  at  the  end  of  the  beam  is  set  as 

zero  by  Kutta  condition.  From  these  relations,  we  obtain 
the  strength  of  circulations  of  all  referenced  points  by 
solving  the  following  equation 


ai,l  ■ 

^Mt) 

"  ' 

*«,.!  - 

^BV.W+t 

— 

b.. 

0 

■  0  1 

P 

1 

b*v* i . 

(19). 


The  complex  velocity  potential  /{ z )  corresponding  to 
Eq.(14)  is  derived  as 


log(z-2tv(/))  . (20). 

Substituting  Eq.(20)  into  Blasius  Theorem,  we  obtain 
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the  fluid  force  exerted  on  the  body  as  the  Kutta 
Joukowski  lift  force, 

/=> 

The  fluid  force  acting  on  the  ;-th  discritized  beam, 
namely  body  i,  is  easily  given  from  Eq.(21)  as 


FMO~iFJ 


M‘)  ~  X  F*U) 

j=i'(nv- l)»l 


'  »  I  ~  >  1 

constraint  block  ;  •'  si 

ii\,  |  gap  guide./ 

*  »  •  Jf 

•  t 


j  r\  1 FRP  beam  ] 

-  A 

;  inlet  of  gap  ^ 


To  avoid  D’Alembert’s  paradox,  we  introduce  the 
drag  D  as  the  ^-directional  resistance  force  with  the  form 

D  =  CdA^j-  . (23), 

where  CD  and  A  are  the  drag  coefficient  and  A  is  the 
projected  frontal  area  of  the  beam. 

The  generalized  fluid  force  acting  on  body  i  is 
given  as 

Q'.h*  -sinAlKJJO)  . (24) 

[sin^  cos^,  JI^J  I  0  j 


%  1 

■4 _  vi "  ^ 

k.-| 

j  -p  I  .  r  -~j~~ . »  ,  I  v  fe 

Ut  1  ..5.  I  .  .  ?.!  ■•••-  •‘•I 

•*&*$&* f  — ■  -r-. . . .  ;  V  . 


Fig.4  Experimental  setup 
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2.4  Equation  of  motion 

The  constraint  equation  of  the  beam  is  written  as 

0  =  1®^  <pD}7  . (25), 

where  Ok  is  the  kinematic  constraint  equation  for  the 
hinge  between  bodies  ;-l  and  /,  and  is  the  driving 
constraint  equation  for  the  left-end  body 

<PD  =(x, -/)+JViA  =  0  . (16). 

The  equation  of  motion  with  constraint  is  obtained 
by  introducing  Lagrange  multiplier  X  [e.g.  10,1 1]  as 

[."  7JK) 

where  M  and  Oq  are  mass  matrix  and  Jacobian  matrix. 

When  the  contact  force  and  fluid  force  work  on  body 
/,  the  response  simulation  must  be  carried  out  by  adding 
not  only  Qa,  but  also  mQj  and  Q(  to  Q,  in  Eq.(27). 

Q,  =Qr+“Q,  +Qf  . (28)- 

3.  EXPERIMENT  OF  SPAGHETTI 
3.1  Experimental  setup 

Figure  4  shows  the  experimental  setup  that  we 
developed  for  investigating  the  Spaghetti  Problem.  The 
FRP  thin  beam  is  regarded  as  the  Spaghetti  ‘specimen’. 
One  end  of  the  FRP  thin  beam  is  clamped  at  the 
circumference  point  of  the  driving  wheel.  The  FRP  beam 
is  also  supported  horizontally  by  the  constraint  block, 
which  is  made  of  Teflon.  The  wheel  has  400mm  diameter 
and  is  driven  by  the  AC  servomotor.  The  FRP  thin  beam 
is  pulled  into  the  gap  at  the  inlet  of  the  constraint  block 
with  velocity  V.  A  couple  of  tapered  guides  are  provided 
in  front  of  the  inlet  of  the  constraint  block. 
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Fig.5  Beam  behavior  (  K=4m/s) 

The  length,  width  and  thickness  of  FRP  beam  are 
500mm,  30mm  and  1.6mm.  Its  density.  Young’s  modulus 
and  damping  ratio  of  it  are  1.4xl03kg/m3,  7.5xl09N/m2 
and  0.043.  The  pulling  velocity  V,  the  tapered  guide  angle 
a,  and  clearance  size  Cp  are  regarded  as  parameters.  We 
set  F— 1.0, 2.0, 3.0  and  4.0m/s,  a,  =10, 15, 30  and  60deg., 
Cp  =0.1,  0.8  and  1.6mm.  In  each  experiment,  the  wheel 
was  controlled  to  have  a  constant  angular  velocity  within 
0.05second. 

The  lateral  displacement  of  the  FRP  beam  is 
measured  by  the  laser  beam  position  sensor  located 


20mm  in  front  of  the  inlet  of  the  gap.  The  deformed 
shape  of  the  FRP  beam  is  also  recorded  with  a  high¬ 
speed  video  camera  of  1000  frames/s. 

3.2  Experimental  and  simulation  results 

Experimental  results  for  the  time  evolution  at  the 
deformation  of  the  FRP  beam  with  the  tapered  guide  are 
compared  with  simulation  results  in  Fig.  5.  These  snap¬ 
shots  were  recorded  by  a  high-speed  video  camera  for  a 
system  with  V  =  4.0  m/s,  a,  =15deg.  and  Cp  =0.  1mm.  It 
is  found  that  at  first  the  intermediate  point  of  the  beam 
contact  the  upper  guide  and  the  beam  end  bends  upward, 
then  the  most  of  the  beam  surface  contacts  the  upper  and 
lower  guides  as  it  is  pulled  into  the  guide. 

In  the  numerical  simulations,  we  divided  the  FRP 
beam  into  48  elements.  It  was  found  that  this  number  is 
large  enough  to  obtain  the  sufficiently  precise  value  of 
static  deformation  with  the  finite  segment  method  used 
in  this  simulation.  We  set  the  spring  constant  k+  and  the 
damping  coefficient  between  each  body  as  65.1  Nm 
/rad.  and  5.67xl0'sNms/rad..  We  also  set  the  spring 
constants  and  the  damping  coefficients  of  the  gap  as  kt= 
3.0  xl06Nm/rad.,  k2=  6.0  xlO^Nm/rad.,  C|=1.53xl0‘4Nm 
■s/rad.  and  C|=l. 53x1 0"*Nm  s/rad.. 

From  this  result,  we  find  that  good  agreement 
between  the  numerical  and  experimental  results  for  both 
frequency  and  deformed  shape.  This  indicates  that  the 
model  can  simulate  the  Spaghetti  Problem  quite  well. 

4.  SPAGHETTI  IN  FLUID 
4.1  Simulation  parameters 

We  conducted  numerical  simulations  to  examine  the 
effect  of  fluid  force  on  the  Spaghetti  and  Reverse 
Spaghetti  Problems  in  cases  for  pulling  into  and  drawing 
out  from  the  wall  gap  with  the  beam  of  three  kind  of 
material,  namely,  FRP,  Aluminum  alloy  and  steel  as 
shown  in  Table  1 . 

We  choose  fluid  density  p,  pulling  or  drawing 
velocity  V and  beam  material  as  parameters.  We  set  fluid 
density  p  as  0.0,  1.2,  1000  kg/m3  representing  in  the 
vacuum,  in  the  air  and  in  the  water.  We  also  set  the 
driving  velocity  Fas  1,  2,  3, 4  and  5  m/s. 

We  put  five  discrete  vortexes  on  each  rigid  body 
(nc= 5),  because  it  is  sufficient  number  to  simulate  the 
fluid  force  that  is  obtained  by  the  well-known  theoretical 
ones  on  the  plate.  We  set  the  steady  velocity  of  flow  U  as 


Tablel  Beam  properties 


Material 

FRP  |  AI.  alloy  |  Steel 

Length  (mm) 

500 

Thickness  (mm) 

1.6 

_ Density  (xlO'kg/nd) 

1.40 

2.86 

7.85 

Mass  of  Beam  (kg) 

1.12 

2.29 

6.28 

Young's  Modulus  (GPa) 

7.80 

99.0 

206 

Bending  Rigidity  (Nm2) 

2.66 

33.8 

70.3 

zero,  that  is,  the  relative  flow  velocity  to  bodies  is  equal 
to  the  driving  velocity.  We  omit  the  gravity  force  in  the 
case  of  Reverse  Spaghetti  Problems,  because  the  gravity 
force  makes  it  difficult  to  judge  the  divergence  type 
instability  from  the  deformation  of  the  beam 

In  the  case  of  Reverse  Spaghetti  Problems,  we  apply 
the  impulse  type  disturbance  at  the  free  end  of  the  beam 
tip  for  /-direction  when  a  quarter  length  of  beam  is 
drawn  out  from  the  inlet  of  the  wall.  Such  a  disturbance 
is  very  important  to  judge  the  stability  or  instability  of  the 
system. 

4.2  Simulation  results 

Figure  6  shows  the  time  history  of  lateral 
displacement  at  the  free  tip  of  the  steel  beam  for  five 
kinds  of  the  driving  velocity  in  the  case  of  the  density  of 
the  fluid  /7=1000kg/m3.  In  the  case  of  K=1  m/s,  the 
displacement  of  the  steel  beam  decreases  with  the 
damped  free  vibration  after  the  disturbance  is  applied, 
and  it  is  stable.  In  the  case  of  F=2m/s,  the  displacement 
of  it  decreases  more  quickly.  In  the  case  of  F=3m/s,  the 
displacement  of  it  decreases  like  an  over  damping  motion 
and  a  small  residual  displacement  is  observed.  In  the 
cases  of  V=A  and  5m/s,  the  displacements  of  it  increase 
monotonously,  namely,  it  is  the  divergence  type 
instability.  Then  the  divergence  type  instability  is  getting 
to  arise  between  2  and  3 m/s.  In  the  cases  of  the  aluminum 
alloy  and  FRP  beam,  the  divergence  type  instability  is 
caused  about  2m/s,  and  is  caused  lower  than  lm/s, 
respectively.  These  results  indicate  followings:  fluid  force 
suppress  the  displacement  of  the  beam  as  the  damping 
force  in  the  low  driving  velocity,  and  it  works  the 
exciting  force  in  the  high  driving  velocity,  the  bending 
stiffness  of  the  beam  gives  significant  affect  on  the 
stability. 

Figure  7  shows  the  effect  of  the  fluid  density  on  the 
response  of  lateral  displacements  at  the  free  tip  of  the 
steel  beam  in  the  case  of  K=4m/s.  In  the  case  of 
/7=0.0kg/m3  and  p=  1.2kg/m3,  free  vibration  is  caused 
after  the  disturbance  is  applied  and  an  imperceptible 
difference  is  observed  between  amplitudes  of  the  beam. 
In  the  case  of  /7=1000kg/m3,  the  displacement  increases 
monotonously.  This  result  indicates  that  the  effect  of  the 
fluid  force  is  more  effective  as  the  fluid  density  is 
increase  and  the  fluid  force  by  high-density  fluid  works 
so  as  to  unstable  the  system. 

Figure  8  shows  the  effect  of  beam  material  on  the 
response  of  lateral  displacement  in  the  case  of  fluid  of 
/7=1000kg/m3  and  V=3 m/s.  The  lateral  displacement  of 
the  steel  beam  holds  about  0mm,  while  lateral 
displacements  of  the  aluminum  alloy  and  FRP  beams 
increases  with  time.  These  results  indicate  that  the 
rigidity  of  the  beam  is  higher,  the  displacement  is  smaller. 

From  these  simulation  results,  the  fluid  force  is 
clarified  to  play  an  important  role  at  the  Reverse 
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Spaghetti  Problem  in  our  simulation  condition.  Because 
the  lift  force  generated  by  circulations  works  to  diverge 
the  system  in  the  Reverse  Spaghetti  Problem.  Then  its 
magnitude  increases  in  proportion  to  the  square  of 
driving  velocity. 
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Fig.6  Driving  velocity  effect  on  beam  displacement 


Fig.7  Fluid  density  effect  on  beam  displacement 


5.  CONCLUSION 

We  have  presented  a  mechanical  model  based  on  a 
finite  segment  method  to  simulate  the  Spaghetti  Problem 
and  the  Reverse  Spaghetti  Problem.  It  is  found  that  our 
model  is  capable  of  accurately  simulating  the  dynamic 
behavior  of  the  Spaghetti  Problem :  The  vibration  of  the 
free  beam  tip  becomes  larger  as  the  beam  is  pulled  into 
the  gap.  Next,  we  introduced  the  fluid-elastic  interaction 
force  by  employing  the  discrete  vortex  method  for  the 
Spaghetti  Problem  and  the  Reverse  Spaghetti  Problem. 

Then,  numerical  simulations  and  experiments  with 
the  FRP  beam  demonstrated  that  the  vibration  amplitude 
of  the  beam  rapidly  increases  as  the  clearance  in  the  gap 
becomes  smaller  or  the  pulling  velocity  becomes  larger. 
In  addition,  the  accuracy  of  our  model  for  the  Spaghetti 
Problem  was  examined  by  comparing  the  results  of 
numerical  simulations  and  experiments. 

Finally,  numerical  simulation  results  clarified  that  the 
fluid  force  works  to  lead  the  system  unstable  in  the 
Reverse  Spaghetti  Problem  with  the  higher  driving 
velocity,  the  higher  fluid  density  and  the  lower  bending 
rigidity  beam,  while  it  works  the  damping  force  with  the 
lower  driving  velocity,  the  low  fluid  density  and  the 
higher  bending  rigidity  beam. 

REFERENCES 

[1]  Carrier.  G  F.  (1979)  The  Spaghetti  Problem,  American 
Mathematical  Monthly ,  56,  pp669-672 

[2]  Tabarrok  B.,  Leech  C.  M.  and  Kim  Y.  I.  (1974)  On  the 
Dynamics  of  an  Axially  Moving  Beam,  J.  Franklin  of  Institute , 
297,  pp. 201-220. 

[3]  Yuh  J.  and  Young  T.  (1991)  Dynamic  Modeling  of  an  Axially 
Moving  Beam  in  Rotation:  Simulation  and  Experiment,  Trans. 
ASME  J.  Dynamics  Systems  and  Measurement,  113,  pp34-40. 

[4]  Mansfield  L.  and  Simmond  J.  G.  (1987)  The  Reverse  Spaghetti 
Problem:  Drooping  Motion  of  an  Elastica  Issuing  from  a 
Horizontal  Guide,  Trans.  ASME  J.  Applyed  Mechanics,  54, 
pp. 147-150 

[5]  Stoltej.  and  Benson,  R.C.  (1992)  Dynamic  Deflection  of  Paper 
Emerging  from  a  Channel,  J.  Vibration  and  Acoustics  114,pp!87-193 

[6]  Stylianou  M.  and  Tabarrok  B.  (1994)  Finite  Element  Analysis 
of  an  Axially  Moving  Beam,  Part-1 :  Time  Integration,  J.Sound 
Vibration,  178,  pp433-453. 

[7]  Vu-Quoc  L.  and  Li  S.  (1995)  Dynamics  of  sliding 
geometrically-exact  beams:  large  angle  maneuver  and 
parametric  resonance.  Computer  methods  in  applied  mechanics 
and  engineering,  120,  pp. 65-1 18. 

[8]  Sugiyama,  H.  and  Kobayashi,  N.  (1998)  Analysis  on  Dynamic 
Behavior  of  Spaghetti  Problem,  Proc.  4th  Int.  Conf.  MOVIC,  Vol.l, 
pp3U-316 

[9]  Komaki,  Y.,  Kobayashi,  N.  and  Watanabe,  M.  (2001)  Experimental 
and  Analytical  Investigation  on  Spaghetti  Problem,  ISth  Biennial 
Conf.  on  Mechanical  Vibration  and  Noise,  ASME,  DETC2001/VIB- 
21356,  ppl-7 

[10]  Haug.EJ.  (1989)  Computer  Aided  Kinematics  and  Dynamics  of 
Mechanical  Systems,  Allyn  and  Bacon. 

[11]  Shabana  A.  A.  (1994)  Computational  Dynamics,  John  Wiley 
&  Sons. 


107 


Forces 


My  +  k(y,y)  =  q(y,y,t) 
hydrostatics  undis 


undisturbed 
incoming  wave 


nonlinear  kinematics  k 
nonlinear  applied  forces  q 


diffraction 


radiation 


The  Flow  Problem 

Flow: 

Boundary  conditions 

A«t>  =  <t)xX  +  a>yy+a)Z2  =  o 

. 

n  u  =  — 

dr\ 

‘D,+^(V<I)V<D)-gz  +  5  =  Po 
p  p 

va>.vt:+^  =  «i> 

at 

0>t+±(VcI>V«>)-gz  =  0 

Solution  in  SIMBEL: 

sources  „ . 

•  linearization 

on  the  boundaries 

of  the  strip  ^ 

z 

S'  y  for  a  number  of 

sections, 
heelings, 
draughts 

=>  hydrodynamics  as  a  planar  problem 

T#cfwic/w  UnwUM  Hambuf^-Haiburg 
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Transparent  Structures 


•  Modified  formulation  by  MORISON  et  al.  -j-ra 

•  mei 

dFn  =p5f  ds^  +  CaP^ds%i  +  c4Dd^n|urn  7 


Transparent 

member: 


-  Normalized  acceleration  of  the  fluid 

dvn  ,<3v  . 

at  1  v  t  *' 

-  Relativ  normalized  acceleration  between 
fluid  and  structure 

^  =  e,x(^Lxet) 

-  Normalized  relativ  velocity  between  fluid  and 


^uT.  *<-y 

T,i 


structure 


urn  =  e,x(u,.xet) 


uk  =(uT  +  <oxrs) 
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Short  Term  Statistics 


Random  sea  state  is  represented  by  its  energy  density  spectrum 
S(a)  derived  by  statistical  properties,  e.g.,  parameters  for  sea 
condition  (significant  wave  height  Hs,  characteristic  wave  period  T0) 

•  The  random  wave  train  and  its  corresponding  forces  are  computed 
using  the  superposition  principle  of  waves 

N 

Q a(l)  =  Z  V2S(“n )A®n  COS(-COnt  +  e(o)n )) 

n=1 

Fi(1)(t)  =  XFi((o)A/2S((on)A(on  cos(-o)nt  +  e((on )) 


Second  order  drift  forces  are 


/  1  V'  XT 

/ 1  \  -a  i 

f . \  . 1  /- . \  i-  •> 


}Fi(2)(co)S(co)dco  /  J  \  .  1  J 

Fi(2)(t)  =  ~— - A2(t)  /  V-v./  V/  '  \ 

JS(co)d(o 

0  Irregular  wave  train  £(t)  and  envelope  A(t) 


Technischa  UrwartKM  Hamburg-Harburg 


116 


Line  Generation  (3) 


'  Solution  by  means  of  a  damped  Newton-Raphson  method 
using  the  boundary  conditions 

Design  parameters  subsystem:  dx,  dy  (geometry),  w,  E,  A  (material) 

1 

attachment  point  relativ  rotation  .V(\  * 


contact  point 
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'  Prediction  of  stability  for  specific  operating  conditions 

*  Determination  of  critical  operating  ranges 
s  Comparability  with  experimental  data 

*  Augmentation  of  operating  range 
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Procedure 


Mathematical  model  of  crane  vessel 
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Verification  and  Technical  Use 
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Technical  use  of  the  results 
Instructions  for  use 

Guidelines  for  construction,  development,  and  operation 

Increasing  safety 
Growing  operating  ranges 


Mathematical  Model 
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Numerical  Bifurcation  Analysis 


Ordinary  differential  equation 

i 

Discretization  of 
periodic  orbits 

I 

Tracing  of  periodic 
solutions 

I 

Bifurcation  diagram,  path  following 
(Predictor-corrector  scheme, 
stepsize  control) 
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Numerical  Results 
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Simulation 


P3  -  Motion 

a  =  0.5m 

Q  =  0.8 rad  Is 
I  =  25m 

c,  =  33 ,4kN/m 
c  2  =  2,9kN/m2 
c  3  =  45 ,5kN/m3 

Xt 


s  fitl  y 
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Method  of  Multiple  Scales 

Idea:  " 

'■  Time  is  expressed  by  a  sequence  of  independent  time  scales 


Tn  =  Ent  0  <  e  « 1  n  =  0,1,2 


'  Ansatz-function 

y(E.t)  —  iWmCroJ,,...) 

m=0 


■>  Assumption:  weak  nonlinearity 
*  Investigation  of: 

’  primary  resonances 
1  subharmonical  resonances 
‘  internal  and  combinational  resonances 
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surge 


Method  of  Multiple  Scales 


Path  Following:  Maxima 
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Method  of  Multiple  Scales:  Results 


Results  of  the 
path  following 
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Experimental  Results  (TUHH) 


Bifurcation  diagram 
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Dynamics  of  Crane  Ship  -  P2-Solution 


Experiment  (TUB) 
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Dynamics  of  Crane  Barge  -  P3-Solution 


A  VIRTUAL  MULTIBODY  AND  FINITE  ELEMENT  ANALYSIS  ENVIRONMENT  IN  THE 
FIELD  OF  AEROSPACE  CRASHWORTHINESS 

H.  M.  LANKARANI,  G.  OLIVARES  and  H.  NAGARAJAN 

National  Institute  for  Aviation  Research,  Wichita  State  University,  Wichita,  KS  67260-0093,  USA 


Abstract  Computer-aided  analysis  tools  typically  used  in  the  studies  of  the  aircraft  crashworthiness  arc  discussed. 
A  methodology  is  presented  for  the  entire  design  cycle  from  airframe  to  the  cabin,  seat,  restraint  and  egress  system. 
The  methodology  incorporates  a  combination  of  multibody  modeling  and  non-linear  finite  element  analysis  of  the 
airframe,  seat  and  the  occupant  as  well  as  component  testing  in  early  design  stages,  and  sled  and/or  full-scale  testing 
in  later  stages  of  design  evaluations.  A  Virtual  Reality  (VR)  system  is  utilized  for  effective  system  visualization  and 
to  better  understand  the  interaction  between  the  various  subsystems.  Examples  of  the  use  of  this  methodology  for 
some  of  the  current  crash  safety  issues  arc  presented. 

I.  INTRODUCTION 

A  theory  is  often  a  general  statement  of  principle  abstracted  from  observation  and  a  model  is  a  representation  of 
a  theory  that  can  be  used  for  prediction.  To  be  useful,  a  model  must  be  realistic  and  yet  simple  to  understand  and 
easy  to  manipulate.  These  arc  conflicting  requirements,  for  realistic  models  arc  seldom  simple  and  simple  models 
arc  seldom  realistic.  Often,  the  scope  of  a  model  is  defined  by  what  is  considered  relevant.  Features  or  behavior  that 
are  pertinent  must  be  included  in  the  model  and  those  that  arc  not  can  be  ignored.  Modeling  here  refers  to  the 
process  of  analysis  and  synthesis  to  arrive  at  a  suitable  mathematical  description  that  encompasses  the  relevant 
dynamic  characteristics  of  the  component,  preferably  in  terms  of  parameters  that  can  be  easily  determined  in 
practice  (component  testing).  The  procedure  for  developing  a  model  is  often  an  iterative  one.  The  cycle  begins  with 
identifying  the  purpose  of  the  model  and  its  constraints,  as  well  as  the  kinds  of  simplifying  assumptions  or 
omissions  that  can  be  made,  determining  the  means  of  obtaining  parameters  and  insight  into  the  discipline  are 
essential  to  making  appropriate  simplifying  assumptions.  Whereas  oversimplification  and  omissions  may  lead  to 
unacceptable  loss  of  accuracy,  a  model  that  it’s  too  detailed  can  be  cumbersome  to  use. 

Modeling  and  simulation  arc  especially  beneficial  to  solve  aerospace  crashworthiness  applications,  where  the 
actual  system  docs  not  exist  or  is  too  expensive,  time  consuming  or  hazardous  to  conduct,  or  when  experimenting 
with  an  actual  system  can  cause  unacceptable  disruptions.  Changing  the  values  of  parameters,  or  exploring  a  new 
concept  or  operating  strategy,  can  often  be  done  more  quickly  in  a  simulation  that  by  conducting  a  series  of 
experimental  studies  on  the  actual  system.  The  design  of  aircraft  for  improvement  of  its  crashworthiness  requires  the 
knowledge  and  integration  of  several  items.  These  items  include  the  specifications  and  standards,  human  tolerance, 
injury  criteria,  energy  absorption  concepts  in  airframe  design,  scat  legs,  scat  pan,  scat  cushion,  restraint  systems! 
surrounding  structures,  fire  safety,  economic  and  ergonomic  considerations. 

The  development  of  current  aircraft  crash  dynamics  standards  dates  back  to  the  1970’s  during  which  the  product 
liability  grew  for  small  aircraft  [1],  To  address  the  crashworthiness  characteristics  of  the  transport  category  aircraft, 
small  general  aviation  aircraft,  and  rotorcraft,  Federal  Aviation  Administration  (FAA)  and  National  Aeronautics  and 
Space  Administration  (NASA)  initiated  a  wide  range  of  research  and  development  programs.  These  programs 
represented  a  concentrated  effort  to  analyze  the  aircraft  behavior  and  the  occupant  characteristics  through 
interrelated  studies  of  accident  data,  dynamic  analyses  of  crash  events,  full-scale  aircraft  impact  tests,  and  aircraft 
scat  tests.  A  panel  named  GASP  (General  Aviation  Safety  Panel)  was  also  formed  in  1978  to  make 
recommendations  on  crashworthiness  requirements.  They  considered  survivable  accidents  for  which  the  floor 
remained  intact.  The  results  of  these  studies  formed  the  basis  for  the  development  of  crashworthiness  design 
standards  for  civil  aircraft  [2],  These  requirements  are  defined  in  the  Federal  Aviation  Regulations  (FARs)  Parts  23, 
25,  and  27  for  genera!  aviation  aircraft,  transport  aircraft,  and  rotorcraft  respectively  [3-5],  These  regulations  were’ 
first  proposed  in  1982  and  they  became  effective  in  1988.  In  general,  the  FARs  contains  two  distinct  dynamic  test 
conditions.  Tcst-1  conditions,  illustrated  and  described  in  Figure  1,  require  a  scat  inclination  of  60  degrees  in  pitch 
and  a  mean  velocity  change  of  no  less  than  30  ft/scc  (20  mph  =  9  m/s),  and  is  intended  to  evaluate  the  means 
provided  to  reduce  the  spinal  loading  and  related  injuries  produced  by  the  combined  vcrtical/horizontal  load 
environment  typically  generated  by  an  aircraft  crash  event.  Tcst-2  conditions,  illustrated  and  described  in  Figure  1, 
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require  the  inclination  of  the  seat  on  the  track  by  1 0  degrees  in  yaw  direction  and  a  mean  velocity  change  of  no  less 
than  42  ft/scc  (29  mph  =  13  m/s)  in  the  longitudinal  direction.  To  account  for  a  reasonable  floor  warpage  level  that 
may  occur  during  a  crash,  one  of  the  seat  tracks  is  misaligned  by  10  degrees  in  pitch  and  the  other  one  by  10  degrees 
in  roll.  The  Tcst-2  conditions  arc  intended  to  provide  an  assessment  of  the  seat  structural  performance  and  the 
occupant  restraint  system.  The  deceleration  pulses  in  both  tests  are  triangular  shaped. 


Figure  l  -  Dynamic  test  requirements. 

The  pass/fail  criteria  are  based  on  the  data  collected  from  accidents  and  the  recommendation  of  the  GASP  on 
the  frequency  of  major  fatal  injuries  to  specific  body  regions  in  aircraft  accidents.  The  injury  and  pass/fail  criteria  in 
the  FARs  include  the  following: 

a.  Maximum  compressive  load  measured  between  the  pelvis  and  the  lumbar  spine  (of  the  Part  572  Subpart  B 
Hybrid  II  ATD,  per  FARs)  must  not  exceed  1500  pounds  (6675  N). 

b.  Loads  in  the  individual  straps  must  not  exceed  1750  pounds  (7785  N)  for  pilot  and  2000  pounds  (8,900  N)  for 
passengers. 

c.  The  compressive  load  in  the  femur  of  Hybrid  II  ATD  (Anthropomorphic  Test  Dummy)  must  not  exceed  2250 
pounds  (10,000  N).  This  requirement  is  only  for  transport  category  (Part  25)  aircraft. 

d.  The  Head  Injury  Criteria  (HIC),  evaluation  for  the  Hybrid  II  ATD  must  not  exceed  1000  [6]. 

HIC  = 


In  contrast  with  the  automotive  industry,  in  the  aerospace  industry  numerical  simulation  methods  are  primarily 
used  at  the  very  end  of  the  product  development  process.  Often  they  are  applied  to  confirm  the  reliability  of  an 
already  existing  design,  or  sometimes  for  further  design  improvements  by  means  of  optimization  methods. 
Numerical  simulation  methods  arc  much  more  efficient  when  used  at  an  early  stage  of  the  product  development 
process.  In  this  way,  the  number  of  hardware  tests  can  be  reduced  since  a  profound  knowledge  of  the  model  already 
exists.  The  intend  on  this  paper  is  to  give  an  overview  of  the  different  simulation  techniques  (multibody  and  finite 
element  method  approach)  that  could  be  implemented  at  the  early  design  stages  of  the  airframe,  interior,  and 
evacuation  systems.  Crashworthiness  problems  arc  best  addressed  in  a  systems  approach  utilizing  combinations  of 
CAE  tools,  component  tests,  sled  and/or  full-scale  tests. 

2.  COMPUTE  AIDED  ENGINEERING  TOOLS  FOR  SEAT,  OCCUPANT  AND  AIRFRAME 
MODELING 

To  improve  aircraft  crash  safety,  conditions  critical  to  an  occupant’s  survival  during  a  crash  must  be  known.  A  large 
number  of  possible  aircraft  crash  environments  exist,  and  the  impact  sled  testing  may  neither  be  possible  nor 
feasible  for  some  configurations.  Cost  and  time  are  also  other  burdens  of  testing  procedures.  Furthermore,  prior  to 
testing,  multiple  simulations  (analysis)  must  be  conducted  to  better  define  the  experimental  testing  program. 
Rigorous  analytical  techniques  arc  necessary  for  design  of  crashworthy  aircraft  airframes,  seats,  occupant 
surroundings,  and  restraint  systems.  Validated  analytical  models  also  reduce  the  necessity  of  fabrication  of  design 
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modifications.  Some  of  the  non-linear  finite  element  analysis  codes  used  for  modeling  and  analysis  of  aircraft  scats 
and  interiors  (structures)  arc  LS-DYNA,  MSC/DYTRAN,  MARC  and  PAM-CRASH.  Analysis  codes  that  model  the 
dynamic  response  of  a  human  or  ATD  during  a  crash  arc  known  as  gross  motion  simulators.  These  models  arc 
comprised  basically  of  kinematically  connected  body  segments  with  joint  stiffness  and  contact  forces  between 
penetrating  segments  or  segments  in  contact  with  the  surrounding.  Some  of  the  existing  body  gross  motion 
simulators  include:  ROS,  CAL2D,  HSRI,  MVMA2D,  SIMULA,  PROMETHEUS,  CAL3D,  UCIN,  SOM-LA/TA 
[!2A  Currcnt|y-  the  codes  mostly  used  for  reconstruction  of  aircraft  crash  scenarios  arc 
SOM-LA/TA ,  ATB,  and  MADYMO.  More  advanced  ATD  and  human  finite  element  models  are  also  available 
these  days  for  detailed  assessment  of  the  injury  potential  to  different  body  regions.  A  systems  approach,  shown  in 
Figure  2,  is  used  for  seat  design  problems  utilizing  nonlinear  finite  element  tools  with  experimental  component  tests 
to  va  idate  the  models,  and  iterative  analysis  for  the  final  scat  design.  Each  element  in  the  load  path,  namely  the 
scat  legs,  pan,  and  cushion,  is  analyzed  individually  as  well  as  its  function  in  the  entire  scat  model. 


Figure  2.  Systems  approach  in  designing  an  aircraft  scat. 


The  survivability  of  the  occupant  in  the  event  of  an  aircraft  accident  primarily  depends  on  a  number  of  key  features 
like  maintaining  a  survivablc  volume  around  the  occupant,  which  is  the  passenger  compartment,  having  effective 
restraints  features  to  properly  restraint  the  occupant  within  the  survivablc  volume,  limiting  the  occupant  loads  by 
having  energy  absorbing  structures  and  scats  to  have  effective  evacuation  systems  in  place  for  the  mitigating  ofpost- 
crash  hazards.  A  methodology,  shown  in  Figure  3,  is  used  for  the  development  of  safety  systems  in  an  aircraft 
utilizing  finite  element  tools,  multibody  modeling  techniques  and  virtual  reality  tools  for  the  safe  egress  of  the 
occupant  from  an  aircraft  in  the  event  of  a  crash.  The  methodology  uses  the  responses  from  the  aircraft  response 
with  the  impact  surface,  obtained  from  finite  element  modeling  of  the  impact,  being  applied  to  the  occupants  and 
designing  effective  systems  for  the  safety  of  the  occupant  during  the  event  using  multibody  modeling  tools  and  the 
modeling  the  egress  of  the  occupant  from  the  aircraft  using  virtual  reality  tools. 


Figure  3.  Virtual  development  cycle  for  aerospace  safely  systems. 
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3.  AIRFRAME  CRASHWORTHINESS  DESIGN 

Crash-resistant  features  and  design  methodologies,  such  as  Aircraft  Crash  Survival  Design  Guide  [1]  are  based 
on  hard  surface  impacts.  Accident  data,  however,  indicates  that  only  1 8%  of  potentially  survivable  civilian  crashes 
occur  on  hard,  prepared  surfaces  [2].  The  statistics  are  even  lower  for  the  army  at  7%  and  the  Navy  at  zero  percent 
[3],  In  contrast,  51%  of  civilian  and  83%  of  Navy  crashes  occur  on  water  and  soft  soil.  The  crash-resistant 
subsystems  designed  for  rigid  surface  impacts,  such  as  landing  gears  or  sub  floors,  are  not  as  effective  in  soft  soil 
and  water  since  the  structure  undergoes  different  loading  conditions.  Hard  surface  impacts  introduce  distributed 
loads  into  the  stiffest  structural  members,  such  as  keel  beams  and  frames. 

Nowadays,  there  is  no  reliable  procedure  for  predicting  the  interaction  processes  that  will  occur  between  soil  or 
water  and  an  aircraft.  While  the  in-flight  behavior  of  the  aircraft  can  be  predicted  with  an  optimum  degree  of 
precision,  the  same  cannot  be  said  for  the  phenomenological  behavior  that  takes  place  at  impact.  This  is  due 
primarily  to  the  lack  of  knowledge  and  to  the  complexity  of  the  soil  behavior  to  allow  a  reliable  prediction  of 
reactive  forces  against  various  geometries  of  the  impact  when  subjected  to  a  dynamic  loading  situation.  The 
functional  relationships  and  behavioral  characteristics  of  soil  and  water  are  much  more  complex  than  for  other 
common  engineering  materials,  thus  making  generalized  behavior  conditions  extremely  difficult  to  determine  with 
reliable  accuracy. 

3.1  ANALYSIS  OF  AND  AIRCRAFT  DROP  TEST  ON  SOFT  SOIL 

A  soil  model  developed  in  LS  DYNA  [10]  is  validated  against  experimental  results.  Figure  4  shows  a  model  of  the 
instrumented  cone  used  in  the  experimental  setup,  wherein  the  cone  was  dropped  from  a  predefined  height  on  to  the 
soft  soil  and  the  depth  of  indentation  was  measured,  and  the  also  the  model  developed  in  LS  DYNA. 


Figure  4.  Modeling  a  cone  impact  on  soft  soil. 

Four  identical  four-place,  high  wings,  single-engine  airplane  specimens  with  nominal  masses  of  1043  kg  were 
crashed  at  the  Langley  Impact  Dynamics  Research  Facility  [8]  under  controlled  free-flight  test  conditions.  These 
tests  were  conducted  with  nominal  velocities  of  25  m/sec  along  the  flight  path  at  various  flight-path  angles,  ground- 
contact  pitch  angles,  and  roll  angles.  Three  of  the  airplane  specimens  were  crashed  on  a  concrete  surface;  one  was 
crashed  on  soil.  Each  airplane  had  a  gross  mass  of  1043  kg  and  the  pilot,  copilot  were  represented  by 
anthropomorphic  dummies.  The  airplane  specimen,  suspended  by  two  swing  cables  attached  to  the  top  of  the  gantry. 
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Figure  5.  Full-scale  crash  impact  test  facility  [8] 
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The  airplane  contacted  the  soil  impact  surface  on  the  nose  gear  with  the  velocity  of  25.3  m/scc  along  a  flight  path 

fmmthl  A,,  |dCgrTh  3nd  T  3  r°"  an8iC  °f“J1'5  dCgrCCS'  Pr'0r  10  thc  tCStS  thc  cn8incs  were  completely  removed 
from  the  fuselage.  The  accelerates  measured  on  the  floor  of  the  aircraft  were  nominally  20  to  25g’s  The  aircraft 

t  US'ng  tHC  fmitr  me-h0d'  ThC  m0dC'  iS  mCShcd  Usi"£  4  nodc  quadrilateral  shell  elements.  The 

model  had  the  same  mass  of  1043  kg  as  in  thc  actual  test.  Figure  6  illustrates  thc  crash  simulation  of  thc  airplane 
during  a  negative  pitch  (node  down)  crash  starting  at  thc  initial  ground  contact.  Thc  airplane  contacted  th£  soil 

ZTd  T.  7'  “T  ty,°  25  3  m/SCC  al°n8  3  fl'ght  pa,h  anglc  of~32  dc8rccs-  Thc  nose  began  to  buckle 

fSZgc  failed  a[  Tib3  e8c0Th  °  °9  SCC  in‘°  the  imPac*-  Thc  Section  of  thc 

tuselage  failed  at  0  16  see.  Thc  airplane  model  began  to  plough  into  thc  soil  creating  a  crater  in  thc  soil  model 

throwing  out  the  deleted  nodes.  The  acceleration  profile  in  the  Z-direction  had  two  spikes,  the  fircone  is  when The 

nose  just  touches  the  soil  and  thc  second  one  is  due  to  the  fuselage  impact  on  the  soft  soil.  The  first  one  reached^ 

henTZ  while  thc  second  one  had  reached  30g.  The  acceleration  data  was  obtained  at  thc  center  of  mass  of 

the  a  rcraft  mode!  unlike  in  thc  drop  test  where  it  was  measured  at  different  locations  on  the  cabin  floor  Overall  the 
Simu  a  ion  had  n  rpasnrwWp  .1 _ 1  •  .  .  v«wu  nuui.  ovudll,  inc 


Figure  6.  Aircraft  impact  on  soft  soil. 

The  acceleration  profiles  from  this  lest  arc  used  as  input  for  the  occupant  simulation  using  multibody  tools,  to  obtain 
tile  "uric"  o'E^m'"6  '"’PaC'-  AirCra“  SyS,CmS  'ikC  “S  rCS"ai",S  "C  S“”bl>'  '»  «*»* 

3.1  HELICOPTER  IMPACT  ON  WATER 

™°dcl  dpVd°pC_d  }n  LS[?YNA  is  validated  against  experimental  results  conducted  by  dropping  a  ball  into  a 
Scn°L“  8UrC  S  Pr0CCSS  °f  Va'idati0n  °f  thC  W3tCr  m0dd  Using  ,he  internal  results  and  finite 


rigurc  7.  Validation  of  water  model. 


airfromn7  hH  3  US,  Army  Yuma  Prov,n8  Ground  utilizing  a  surplus  Bell  Helicopter  UH-1H  “Huey” 

airframe  conducted  a  vertical  dynamic  test.  The  test  helicopter  had  been  striped  of  nearly  all  components  such  as 
eng.ne/transmission,  tail  boom,  landing  gear,  etc.,  leaving  the  bare  hull.  The  test  weight  was  2260  lbs  Thc  test  was 

ScV™rDldiZ  0f  app7‘matc,y  9  ft-  rSUred  fr0m  the  l0WCSt  poin‘  of  th?  helicopter  bluy  7o  the  ^Tter 

surface  wavcs.^TTic  water  dcpth^tUtclmpact'point^w^^^roximate^'Whichcs^Tlicpea^pr^urer^^ing  at  the 


The  dimensions  of  the  air  and  water  models  used  in  thc  eulerian  simulation  ofball  impact  on  water  were  scaled  uo  to 
accommodate  the  helicopter  model,  shown  m  Figure  8.  Thc  clement  formulation  of  the  model  is  thc  same.  The  mesh 
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density  and  the  total  number  of  the  solid  elements  remain  the  same.  Helicopter  is  lagrangian  solid  here  modeled  with 
Bclytschko-Tsay  shell  elements  and  air/watcr  stays  as  the  culcrian  fluid.  The  boundary  conditions  also  arc  similar  to 
thcculcrian  ball  impact  simulation. 


Figure  8.  Deformed  helicopter  showing  the  stress  distribution  and  the  acceleration  profile  of  impact. 

The  water  depth  at  the  impact  point  was  90  inches.  The  impact  attitude  was  pure  flat  (no  pitch  or  roll).  The 
helicopter  sustained  major  structural  damage  from  the  water  impact.  Figure  9.  shows  stressed  state  of  helicopter  at 
initial  touchdown.  The  stresses  increase  till  the  time  the  whole  body  comes  in  initial  contact  with  the  water  surface. 
Subsequently,  the  stresses  drop  as  the  helicopter  sinks  down  with  a  constant  velocity.  The  peak  value  of  acceleration 
is  around  77’g’  and  a  second  peak  of  23’g’comcs  a  little  later.  Then  slowly  the  acceleration  drops  down  to  zero 
when  the  helicopter  is  sinking  down  with  a  constant  velocity.  There’s  another  acceleration  peak  of  about  3-4’g’ 
when  the  wings  impact  the  water  surface.  Since,  the  velocity  has  already  reduced  to  a  minimal  value  after  the  initial 
impact,  the  value  of  the  deceleration  because  of  the  wing  impact  is  meager 

4.  CAE  AND  VR  TOOLS  FOR  CABIN  INTERIOR  MODELING  AND  VISUALIZATION 

Both  the  multibody  and  the  finite  element  method  offer  their  specific  advantages  and  disadvantages  for  cabin 
interior  crashworthiness  design  applications.  The  multibody  approach  is  particularly  attractive  due  to  its  capability 
of  simulating  in  very  efficient  way  complex  kinematical  connections,  while  the  finite  element  method  offers  the 
capability  of  describing  (local)  structural  deformations  and  stress  distribution.  The  following  example  application 
will  give  an  overview  on  how  the  coupling  of  these  two  methods  in  conjunction  with  component  testing  is  applied 
throughout  the  system  development  cycle. 

4.1  FRONT-ROW  OCCUPANT  ENVIRONMENT  DEVELOPMENT  CYCLE 


1  J 


Figure  9.  CAE/Testing  Development  Cycle. 
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Airline  scat  manufacturers  have  experienced  some  difficulty  in  satisfying  the  Head  Injury  Criteria  (HIC) 

SnH  h1™6  aAR  25.  562,[l]  ‘6  8  d-vnamic  scat  tcst  requirements  for  so-called  “front-row  scats”  that  arc  located 
behind  a  bulkhead  or  cabin  class  divider.  Traditionally  sled  testing  has  been  used  to  develop  aircraft  interiors  Due 
to  the  high  cost,  test  set  up  time,  and  complexity  of  developing  the  system  by  using  sled  testing,  a  Multibody/FEA 

toKfinTf " v  .r!J  C°7rCn’  S'C,d  tCSting  is prCSCnted  In  this ProJ'cct  thc  fr^t-row  scat  environment  had 
Nd  H  y  hrCC  U  7!  7  (nyl°n>  polyeslcr  8%’  and  P^tcr  19%),  three  bulkhead  (Aluminum 
Standard  Nomex  Honeycomb  and  Modified  Nomex  Honeycomb)  materials  were  available;  and  six  possible  scat 
setback  configurations  (28,  30,  33,  35,  38,  and  40  inches)  to  choose  from.  If  we  were  to  develop  this  system  thc 
traditional  way  (sled  testing)  we  would  have  to  test  54  different  configurations,  and  since  usually  Two  slcd  tcsts  arc 
conducted  per  configuration  we  would  have  a  total  of  108  sled  tests.  A  program  like  this  could  take  up  to  three 
months  of  sled  testing,  and  hundreds  of  thousands  of  dollars  in  components.  In  order  to  avoid  thc  high  cost  and  the 
long  development  cycle  CAE  and  VR  tools  in  conjunction  with  component  and  sled  testing  can  reduce  the 

development  cycle  to  a  month  of  simulation  work,  including  6  sled  tests  for  model  validation,  4  component  tests 
and  2  final  system  certification  tests.  1  ’ 

a)  PHASE  /  AND  II:  COMPONENT  TEST,  MODEL  DEFINITION  AND  VALIDATION 

A  Multibody/FEA  model  of  thc  scat/ATD/buIkhcad  test  configuration  is  shown  in  Figure  8.  Thc  rigid  scat  was 

scat^ack  Thc'ronmrl1?  f,XCd1'n  7“'  °nC  P'anC  rcprescn,s  thc  scat  pa"  while  thc  other  represents  the 

scat  back.  Thc  contact  forces  between  these  planes  and  thc  appropriate  anthropomorphic  test  dummy  (ATD)  body 

segments  were  defined  in  terms  of  thc  appropriate  loading  and  unloading  curves  obtained  through  component! 


Figure  10.  Multibody/fca  model  and  sled  test  setup. 

7“,  fd  PCrCCS,C  Hybrid  11  ,ATD  mu,tibody  modcl  was  p|accd  in  ‘he  scat.  A  two-point  restraint  system  was 
modeled  using  belt  properties  that  were  representative  of  the  system  used  in  the  sled  tests.  Thc  anchor  points  of  thc 
belt  were  located  at  the  intersection  of  thc  seat  pan  and  scat  back  as  shown  in  Figure  8.  Thc  floor  was  ilso  modeled 

bulklrnTd  3  r,^diPH3nC'  A!1 7dd“Tal  ng'd  P’anC  W3S  p)accd  in  ftont  of  lhc  'cgs  just  below  thc  bulkhead.  Thc 
khcad  was  modeled  using  180  quadrilateral  shell  elements  representing  a  30  x  24  in  (76  2  x  60  9  cm!  bulkhead 
surface.  An  elasto-plastic  materia,  mode,  was  used  to  define  the  behavbr  of  the  bulkhead  m.53,  Th^2I^ 
s  ram  curve  used  in  thc  modcl  were  acquired  from  a  series  of  tensile  tests  of  using  an  MTS  servo-hydraulic  test 

narameu^  TT  ,nipactor  oad/dcncct,on  tests  sincc  this  data  was  not  available  in  literature.  Prior  to  conducting  thc 
parameter  studies  the  models  were  validated  with  sled  test  data  for  thc  three  different  bulkhead  configurations8  As 
shown  on  figure  1 1  there  is  good  correlation  between  thc  models  and  thc  sled  tests  & 


'  HIC  882  889 

H,  At  31  33 


Figure  1 1 .  Comparison  Head  Acceleration  Profile  Sled  and  MADYMO  Production  Bulkhead 

b)  PHASE  III:  PARAMETER  STUDY 

injUry  CriteHa  3nd  kincma,ics  of  thc  ATD  under  various  seat 
setback  conditions  (28,  30,  33,  35,  38,  and  40  inches),  various  lap  belt  (nylon,  polyester  8%,  and  polyester  19%), 
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and  bulkhead  material  configurations  (aluminum  panel,  standard  Nomex  honeycomb,  and  modified  Nomex 
honeycomb).  These  three  factors  were  identified  as  the  most  important  parameters  influencing  the  magnitude  of  the 
HIC  values.  This  is  due  to  the  fact  that  these  are  the  parameters  that  dictate  the  head  impact  angle,  head  impact 
velocity,  head  impact  acceleration,  and  the  translation  of  the  lower  torso.  From  the  parameter  study  we  concluded 
that  the  lower  the  head  impact  angl.e,  the  higher  the  peak  acceleration  and  HIC  values  become.  The  stiffness  of  the 
lap  belt  material  and  the  scat  setback  distance  are  the  parameters  that  dictate  the  magnitude  of  the  Head  Impact 
Angle.  Belts  with  higher  stiffness  allow  less  movement  of  the  lower  torso.  When  we  have  the  same  setback  distance 
and  different  lap  belt  materials  wc  can  observe  that  the  stiffer  lap  belt  material  the  larger  the  Head  Impact  Angle 
becomes,  this  is  due  to  the  fact  that  a  stiffer  belt  allows  less  forward  lower  torso  displacement  prior  to 
ATD/Bulkhead  impact  hence  allowing  more  rotation  of  the  upper  torso  prior  to  impact.  From  the  sled  test  analysis 
and  the  computer  models  wc  can  observe  that  the  longer  the  seat  setback  distance  the  more  critical  the  rearward 
translation  of  the  torso  after  initial  head  impact  becomes.  This  movement  of  the  lower  torso  during  impact  becomes 
more  critical  for  longer  seat  setback  distances  as  well  as  when  softer  materials  are  used  to  the  bulkhead  structure 
construction. 


Figure  12.  Deformation  of  the  panels  during  impact  for  different  seat  setback  configurations. 

From  the  parameter  study  it  was  observed  that  the  configuration  that  meets  all  the  design  requirements  (biomechanical 
performance,  cost,  legroom,  and  component  availability)  as  well  as  FAR  25  requirements  was  the  aluminum  bulkhead 
with  a  seat  setback  distance  of  35  (0.89meters)  inches  as  shown  in  the  table  bellow. 

c)  PHASE  IV AND  V:  COMPONENT  TEST  AND  CERTIFICATION  SLED  TEST  OF  THE  FINAL  DESIGN 

Due  to  the  high  cost,  test  set  up  time,  and  complexity  of  a  sled  test,  NIAR’s  Enhanced  Head  Injury  Criteria 
Component  Tester  was  used  to  validate  the  final  design  prior  to  conducting  the  final  certification  tests.  This 
component  tester  is  an  inverted  pendulum  type  impactor.  It  consists  of  an  accelerator,  pendulum  arm,  support  arm, 
ATD  head/neck  assembly,  signal  processing  electronics,  and  a  computerized  control  and  data  acquisition  system.  As 
shown  on  table  1  the  component  test  confirms  the  results  obtained  from  the  simulation  design,  consequently  wc 
concluded  that  the  system  was  ready  to  proceed  with  phase  V,  the  sled  test  certification  process. 


Table  I .  Final  System  Configuration. 


Parameter 

Sled 

Component 

Simulation  j 

Bulkhead  Material 

AL  2024  -0 

AL  2024-0 

AL  2024  -O  j 

Seat  Setback  Distance  -  in 

35 

35 

35  ; 

Head  Impact  Velocity  -ft/s 

45.08 

44 

44 

Head  Impact  Angle  -  deg 

38° 

38° 

42° 

Head  C.G.  Peak  Acceleration  -  g 

143 

143 

140 

HIC 

694 

685 

634 

HIC  Window  (At)  -  ms 

23.7 

21.4 

22.8 

Average  Head  Acceleration  -g 

61 

63 

60 

The  results  from  the  sled  test  certification  process  confirm  the  results  of  both  the  component  and  the  simulation 
model  see  table  3  and  figure  13.  By  using  this  Multibody/FEA  technique  in  conjunction  with  component  testing  and 
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If?  Z  ^  °f  Sclcc,in8  thc  P^per  system  configuration  to  meet  the  system 

requirements  but  also  through  simulation  we  gained  a  better  understanding  on  the  ATD  (by  using  3D  Virtual 
Reality  visualization  of  thc  system)  responses  to  thc  different  input  parameters  £ 

1,,  k  £ 

~g  jtM. 

..  .  ..  ... 


Figure  13.  Final  configuration  Italian!  head  eg.  Acceleration  lime  history  for  sled  and  NIAR  component  test. 

5.  APPLICATION  OF  CAE  AND  VR  TOOLS  FOR  VIRTUAL  TESTING  OF  EVACUATION  SYSTEMS 

c  industry  forward  [1 , 1  This  spccihc  CAE  a„d  VR  applies, i„„  show,  how  we 

system  a  les,  like  .hi,  would  be  very  diiTienl,  and  expensire  £,t“„ "  Sphere  tSr  h™  STfEA 
icehmqucs  to  cser.be  the  evacuation  system,  and  a  multibody  model  of  the  ATD  we  can  Sly  S The 
p  formancc  of  the  system.  A  model  of  the  evacuation  system  was  created  usinu  MADYMO  Tim  di  t  , 
consists  of  9800  triangular  elements.  A  typical  evacuation  System  inflator  mass  fi^  Z ^defined  to  tlltl 
slide.  Appropriate  contacts  were  defined  between  thc  multibody  ATD  and  the  evacuation  system  surfaces. 


Figure  14.  ATD  Biomechanical  Response. 


Figure  15.  Evacuation  System  Response 


Ss'erveT S  '“Tn" “  a?'  A\D  “"dCr  ,hCSC  di,rc'cm  ”mbi“1  editions  i,  shown  on  Figure  14  as  we  can 

severe  On  the  o  her h and  f  1  Tn  tTpCra,Uures  <scc  FiSurc  >5),  ‘his  makes  thc  impact  with  the  ground  more 
increasing  the  sliding  vdodty  of  tire  ATfhmid^cJcashigthc  rcbotmd  of  the  h^cTat'dic'cndoflhc  aide!' ^Cr  llCnCC 
6.  VIRTUAL  REALITY  CENTER 

were  uscd°  This  °f  "“T™  s*slcm  l”*™™  tbn  NIAR’s  Virtual  Reality  facilities 

wide  (see  Jure  ltd  kSm  resnl«  of  thc  simulation  in  a  screen  7  If  high  and  IS  fl 

and  extremely  complex  da, a.  VR  iil,  IS 

5 ^~=B^E=~sm 
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cursor.  Another  advantage  of  particular  importance  is  the  sense  of  scale,  which  can  only  be  conveyed  by  immersing 
the  designer  in  the  "design".  The  simulation  technique  showed  on  this  section  could  be  easily  implemented  to 
conduct  ‘virtually’  all  the  required  product  testing  to  ensure  it’s  optimum  functionality  prior  to  building  a  physical 
model.  The  data  generated  by  the  multibody  simulation  of  the  various  crash  event  provides  a  myriad  amount  of  data 
which  needs  to  be  effectively  understood.  The  virtual  reality  environment  provides  a  suitable  platform  for  the 
effective  viewing  of  these  data  and  also  in  understanding  their  significance. 


Figure  16.  Virtual  reality  control  room  and  visualization  of  the  evacuation  simulation  model  at  the  NIAR. 

7.  CONCLUSIONS 

This  paper  presents  examples  of  the  use  of  a  systems  approach  methodology  to  some  of  the  current  aircraft 
crashworthiness  problems.  It  makes  use  of  appropriate  injury  criteria,  component  performance  tests,  full-scale  sled 
tests,  and  the  presented  some  of  the  latest  CAE  and  VR  tools.  The  modeling  of  the  aircraft  impact/accidcnt  is 
accomplished  by  using  finite  element  analysis  and  multibody  dynamic  simulation  tools  as  well  as  projections  onto  a 
virtual  reality  environment.  The  importance  of  CAE  tools  in  aircraft  crashworthiness  problems  is  demonstrated  via 
examples.  This  provides  much  insight  into  the  nature  of  the  scat,  occupant,  and  airframe  responses  individually  and 
collectively.  The  main  purpose  of  utilizing  this  methodology  is  the  anticipation  that  due  to  myriad  amount  of  data 
that  is  generated  by  the  finite  element  and  multibody  simulation  CAE  and  VR  tools  need  to  be  effectively  utilized 
for  analysis  during  the  design  phase. 
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1.  Introduction 

The  most  recent  developments  in  applying  linear  graph  theory  to  multibody  sys¬ 
tem  dynamics  are  presented,  with  particular  emphasis  on  the  symbolic  generation 
of  simple,  compact  equations  that  are  well-suited  for  real-time  simulation. 

An  overview  of  the  modelling  of  flexible  multibody  systems  is  presented  in  the 
next  section,  taking  advantage  of  the  unique  features  of  linear  graph  theory  and 
symbolic  computer  programming.  Graph  theory  is  then  used  to  generate  equations 
in  terms  of  user-selected  coordinates  that  are  well-suited  to  a  given  problem,  and 
to  exploit  special  topologies  such  as  that  found  in  parallel  robotic  manipulators. 
Graph  theory  also  facilitates  the  modelling  of  multibody  and  mechatronic  sys¬ 
tems  using  subsystem  models;  this  is  particularly  useful  for  virtual  reality  (VR) 
applications  when  sections  of  a  model  are  changing  while  others  remain  constant. 

2.  Symbolic  Modelling  of  Flexible  Multibody  Systems 

Consider  the  two-link  robotic  manipulator  shown  in  Figure  1 ,  along  with  its  linear 
graph  representation.  Nodes  in  the  graph  represent  body-fixed  reference  frames, 
while  edges  represent  kinematic  or  dynamic  transformations  associated  with  phys¬ 
ical  components.  Edges  mx  and  m2  represent  the  two  bodies,  which  may  be  rigid 
or  flexible.  Newton’s  Laws  require  that  the  edges  originate  at  an  inertial  frame 
(node)  and  terminate  at  a  body-fixed  frame  (node)  —  usually  at  the  center  of  mass 
for  a  rigid  body,  and  at  one  end  of  a  flexible  beam  element.  For  clarity,  the  physical 
components  are  superimposed  on  the  linear  graph  with  dotted  lines. 

Edges  h7  and  h$  are  the  two  revolute  joints  connecting  the  bodies;  the  “arm 
elements”  r3  -  r5  represent  transformations  from  the  body  frame  to  the  joint 
frames.  These  transformations  are  functions  of  the  body  rotation  and,  for  flexible 
bodies,  the  elastic  deflections.  Edge  r§  is  included  for  the  purpose  of  tracking  the 
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Figure  I.  Two-link  robot  manipulator  and  linear  graph 

position  and  orientation  of  the  tip  of  the  manipulator.  Additional  physical  effects, 
e.g.  motor  torques  and  weights,  are  easily  added  to  the  system  graph. 

Associated  with  each  edge  are  through  (force,  torque)  and  across  (translation, 
rotation)  variables  that  satisfy  the  fundamental  cutset  and  circuit  equations  [1  ].  For 
mechanical  systems,  the  cutset  equations  provide  dynamic  equilibrium  equations 
for  any  combination  of  components,  while  the  circuit  equations  provide  closure 
conditions  around  any  loop. 

If  a  tree  is  selected  for  the  graph,  then  the  circuit  equations  can  be  used  to  ex¬ 
press  all  kinematic  variables  as  linear  combinations  of  the  coordinates  associated 
with  the  tree  edges  (“branches”)  [2].  For  dependent  branch  coordinates,  which 
is  always  the  case  for  systems  with  closed  kinematic  chains,  the  kinematic  con¬ 
straint  equations  are  generated  by  projecting  the  circuit  equations  for  cotree  joints 
onto  the  reaction  space  for  that  joint.  For  holonomic  constraints,  one  obtains  m 
nonlinear  algebraic  equations  in  terms  of  the  n  branch  coordinates  q: 

*(q,0  =  o  (i) 

where  n  -  m  =  /,  the  degrees  of  freedom  (DOF)  of  the  system. 

Once  the  kinematic  equations  are  obtained,  the  dynamic  equations  can  be  sys¬ 
tematically  generated  by  projecting  the  cutset  equations  for  branch  components 
onto  the  motion  space  for  that  component  [2]: 

Mq+  3»qA  =  F  (2) 

where  M  is  the  mass  matrix,  <&q  is  the  Jacobian  of  the  constraint  equations,  the 
Lagrange  multipliers  A  correspond  to  reactions  in  cotree  joints,  and  F  contains 
external  forces  and  quadratic  velocity  terms. 


141 


Alternatively,  the  principle  of  virtual  work  may  be  employed,  especially  when 
flexible  bodies  arc  included  in  the  system  model  [3],  to  obtain  the  dynamic  equa¬ 
tions  (2).  Symbolic  programming  was  found  to  be  particularly  useful  in  imple¬ 
menting  this  latter  formulation  [4],  Multiplications  by  0  and  1  are  eliminated, 
and  trigonometric  simplifications  are  automated.  The  final  kinematic  and  dynamic 
equations  can  be  visually  examined  for  physical  insight,  or  exported  as  optimized 
C  or  Fortran  code  for  subsequent  simulation.  We  have  used  the  Maple  symbolic 
programming  language  to  develop  our  DynaFlex  software1  for  modelling  flexible 
multibody  systems. 

Symbolically,  one  can  also  partition  the  first  variation  of  the  constraint  equa¬ 
tions  into  /  independent  coordinates  q;  and  m  dependent  coordinates  qj: 

$qa<Sqd+  $qi£qi  =  0  (3) 

where  <&q.  =  <93>/3qj  and  $,,d  =  d$/dqd  is  non-singular  as  long  as  the  given 
physical  constraints  arc  not  redundant.  One  can  then  solve  these  linear  equations 
(3)  for  the  transformation  from  dependent  to  independent  variations: 

<$qd  =  =  J  <*qt  (4) 

By  summing  the  contributions  of  all  working  components  to  the  system  virtual 
work  SW ,  and  using  the  above  transformation,  one  obtains: 

SW  =  QT<5q=QT 

where  Q;  arc  the  generalized  forces  associated  with  <Sq;.  Since  these  variations 
are  independent,  each  generalized  force  can  be  set  to  zero  to  obtain  one  dynamic 
equation  per  degree  of  freedom,  from  which  the  constraint  reactions  A  are  elimi¬ 
nated.  In  matrix  form, 

Mq=F(q,q,t)  (6) 

where  M  is  an  unsymmetric  /  x  n  mass  matrix.  In  a  later  section,  this  form  of  the 
dynamic  equations  will  be  used  to  advantage  in  inverse  dynamic  analyses. 

3.  Coordinate  Selection 

By  selecting  a  spanning  tree  for  the  graph,  the  branch  coordinates  q  that  appear  in 
the  kinematic  and  dynamic  equations  are  defined.  This  is  an  important  feature  of  a 
graph-theoretic  approach,  since  most  other  multibody  formulations  are  restricted 
to  a  pre-defined  set  of  coordinates,  usually  absolute  [5]  or  joint  [6], 

Us*nS  gmph  thcoiy,  one  can  generate  equations  in  absolute  coordinates  (select 
all  bodies  into  the  tree),  joint  coordinates  (select  joints  into  the  tree),  or  some 

1  http://rcal.il  watcrloo.caT dynaflex 


%  =  Qi^qi  =  0 


(5) 
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combination  of  the  two.  One  can  even  select  two  different  trees  —  one  to  generate 
rotational  equations  and  one  to  generate  translational  equations.  By  doing  this,  one 
can  reduce  the  total  number  of  equations  to  be  solved,  and  reduce  their  complexity 
at  the  same  time  [2].  By  selecting  coordinates  that  are  best  suited  to  the  problem 
at  hand,  one  obtains  equations  that  are  very  well-suited  to  real-time  simulation  in 
either  a  virtual  reality  environment  or  an  operator-in-the-loop  simulation. 

By  defining  and  selecting  “virtual  joints”  into  the  tree  [7],  it  is  even  possible  to 
generate  equations  in  “indirect  coordinates”  corresponding  to  bodies  that  are  not 
necessarily  adjacent  [8].  Consider  the  open-loop  multibody  system  taken  from  [8], 
and  its  corresponding  linear  graph  in  Figure  2. 


Figure  2.  Open-loop  multibody  system  and  linear  graph 

Once  again,  bodies  are  represented  by  edges  mx  -  m4,  body-fixed  transfor¬ 
mations  by  arm  elements  r5  -  rn,  revolute  joints  by  edges  hu  -  h^,  and  the 
spherical  joint  by  615.  In  addition,  two  virtual  joints  are  added:  a  virtual  revolute 
joint  vhi 6  representing  the  rotation  of  m3  relative  to  mi,  and  a  virtual  spherical 
joint  vbn  to  represent  the  rotation  of  m4  relative  to  the  ground.  Fayet  and  Pfister 
[8]  have  shown  that  the  corresponding  indirect  coordinates  result  in  equations  that 
are  simpler  in  form  than  the  more  traditional  joint  coordinate  equations.  This  is 
due  to  the  fact  that  joint  axes  z-x  and  z3  are  parallel,  and  absolute  angular  coor¬ 
dinates  are  preferred  over  relative  angular  coordinates  [9].  With  a  graph-theoretic 
approach,  one  can  generate  the  motion  equations  in  indirect  coordinates  by  simply 
selecting  vh\§  and  vbn  into  the  tree  in  place  of  h x4  and  615. 

Applying  this  approach  to  a  serial  manipulator  comprised  of  bodies  mx  -  m3, 
the  dynamic  equations  (2)  were  generated  in  terms  of  the  joint  coordinates  = 
[/3i2./3i3,/3i4]T  and  the  indirect  coordinates  q;  =  [/3i2,y9i3,/5i6]T-  Both  sets  of 
coordinates  are  independent  for  this  serial  manipulator,  so  there  are  no  kinematic 
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constraint  equations  and  no  constraint  reactions  A  appearing  in  the  dynamic  equa¬ 
tions.  However,  some  of  the  entries  in  these  equations  will  differ  for  the  two  sets 
of  coordinates,  e.g.  the  second  diagonal  entry  in  the  two  mass  matrices: 

M/3(2,  2)  =  I2z  +  m2l27  +  I3z  +  m3[Z ?8  +  2 /78/9  cos/314  + /g] 

Mi  (2, 2)  =  /2*  +  m2/f  +  m3/78 

The  use  of  indirect  coordinates  results  in  a  simplification  of  the  mass  matrix,  for 
which  the  diagonal  entries  correspond  to  moments  of  inertia  of  “compound  aug¬ 
mented  bodies”  [8].  Table  1  provides  the  number  of  additions,  multiplications, 
and  function  calls  needed  to  evaluate  the  two  mass  matrices. 


TABLE  1.  Number  of  operations 
Adds.  Mulls.  Functs. 


Mp:  27  53  12 

Mi:  20  43  11 


4.  Application  to  Parallel  Manipulators 

For  mult! body  systems  with  special  topologies,  such  as  the  parallel  manipulators 
shown  in  Figure  3  that  have  legs  of  identical  configuration,  linear  graph  theory  can 
be  used  to  exploit  this  topology  during  the  equation  generation  process.  In  com¬ 
parison  with  serial  robots,  parallel  manipulators  have  very  good  performance  in 
terms  of  rigidity,  accuracy  and  dynamic  characteristics,  but  they  are  more  difficult 
to  model.  Merlet  [11]  writes  that  one  school  of  thought  recommends  that  dynamic 
models  should  not  be  used  because  modelling  errors  arc  too  numerous.  Despite 
this,  and  the  fact  that  dynamic  equations  can  be  generated  automatically,  many 
authors  [12,  13]  are  still  performing  manual  derivations  for  parallel  manipulators. 

Symbolic  solutions  fdr  the  inverse  dynamics  are  especially  useful  for  real-time 
control  of  parallel  manipulators  and  other  multibody  systems  [10].  Given  that  par¬ 
allel  manipulators  are  frequently  used  as  input  devices  for  real-time  simulations, 
or  as  platforms  for  flight  simulators,  the  automatic  generation  of  inverse  dynamic 
solutions  facilitates  the  development  of  virtual  reality  environments. 

To  show  how  this  can  be  effected  using  graph  theory  and  symbolic  computing 
consider  the  3-DOF  planar  parallel  manipulator  [14]  shown  in  Figure  3  The  three 
revolute  joints  connecting  the  end  effector  7  to  links  4,  5,  and  6  are  placed  in 
the  cotree  of  the  linear  graph  representation;  the  corresponding  joint  coordinates 
are  thereby  eliminated  from  all  equations.  From  the  projected  circuit  equations  for 
these  three  joints,  one  obtains  the  m  =  6  nonlinear  kinematic  constraint  equations: 

$(q,t)  =  $(0i,02,03,04,05,<Vx7,y7,07)t)  =  0  (7) 
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Figure  3.  Planar  3-DOF  and  spatial  6-DOF  parallel  manipulators 


where  0;,  i  =  1 ...  6,  is  the  coordinate  for  the  revolute  joint  on  the  proximal  side 
of  link  i,  while  2:7,  y7,  and  07  represent  the  motion  of  the  end  effector  7.  Each  of 
these  coordinates  correspond  to  a  joint  in  the  spanning  tree  of  the  graph,  including 
a  “virtual  joint”  between  the  ground  and  the  end  effector. 

These  constraint  equations  can  be  used  to  obtain  the  transformation  (4)  from 
dependent  variations  to  independent  variations  which,  when  combined  with  our 
symbolic  virtual  work  routines,  allows  the  dynamic  equations  to  be  written  in  the 
embedded  form  given  by  equation  (6).  In  an  inverse  dynamic  problem  for  which 
q(t)  is  known,  equation  (6)  can  be  solved  for  the  /  actuator  loads.  Note  that  the 
actuator  loads  will  always  appear  linearly  in  F.  Furthermore,  by  choosing  the 
actuated  joint  variables  as  the  independent  coordinates  q;,  the  actuator  loads  will 
be  decoupled  in  equation  (6),  i.e.  exactly  one  actuator  load  appears  explicitly  in 
each  equation.  Hence,  no  matrix  inversion  is  needed,  unlike  the  approach  in  [12]. 

The  direct  application  of  Maple  algorithms  to  the  solution  of  the  linear  equa¬ 
tions  (3)  for  the  dependent  variations  will  be  called  the  direct  symbolical  approach. 
Due  to  memory  limitations  associated  with  symbolic  programming,  this  approach 
will  fail  when  the  number  of  loop  closure  equations  is  large,  which  is  the  case 
for  the  6-DOF  Gough-Stewart  platform  shown  in  Figure  3.  In  this  situation,  one 
can  still  obtain  the  dynamic  equations  (6)  by  using  a  pseudo-variable  approach  to 
solve  equation  (3)  in  a  way  that  exploits  the  special  topology  [10]. 

To  accomplish  this,  the  set  of  coordinates  are  further  partitioned  as  q  = 
(<li)  Oe,  qdd),  where  q;  are  the  independent  variables  (associated  with  the  ac¬ 
tuators),  qe  are  the  end  effector  variables,  and  qdd  are  the  variables  associated 
with  the  unactuated  joints.  The  so-called  pseudo-independent  variables  are  de¬ 
fined  as  qpi  =  qe,  and  the  pseudo-dependent  variables  qpd  =  (qi,  qdd)-  This 
re-partitioning  of  the  joint  coordinates  leads  to  a  largely  decoupled  linear  system 
of  equations  (3);  this  is  the  essential  feature  of  the  pseudo-variable  approach. 

To  demonstrate,  consider  selecting  the  actuated  joint  angles  01;  02,  and  03  as 


145 


independent  coordinates  q;  for  the  planar  3-DOF  manipulator.  The  partial  deriva¬ 
tives  (Jacobian  matrices)  of  the  loop  closure  equations  (7)  with  respect  to  the 
dependent  and  pseudo-dependent  variables  have  the  structures: 


*  *  * 

*  * 

*  *  * 

*  * 

*  *  * 

*  *  * 

* 

>  *  Qpd  ~ 

*  * 

*  * 

*  *  * 

*  * 

*  *  * 

*  * 

where  an  asterisk  *  indicates  a  non-zero  entry.  One  can  clearly  see  the  decoupling 
that  is  present  in  the  Jacobian  matrix  $qpd  for  the  pseudo-dependent  variables. 
Once  the  pseudo-dependent  variations  are  obtained,  it  is  a  simple  matter  [10]  to 
recover  the  pseudo-independent  variations  and  the  symbolic  transformation  (4). 

In  addition  to  the  direct  symbolical  and  pseudo-variable  approaches,  three  oth¬ 
ers  have  been  implemented  for  comparison.  In  an  implicit  symbolical  approach, 
the  actuator  loads  are  expressed  in  terms  of  the  entries  of  the  transformation  matrix 
J,  which  are  calculated  and  saved  symbolically.  In  a  combined  symbolic/numeric 
approach,  the  actuator  loads  are  again  expressed  in  terms  of  the  entries  in  J,  which 
are  obtained  numerically  by  solving  /  linear  systems  $qdjfc  =  -iph,  k  =  \...f, 
where  j*,  and  <pk  are  the  fc-th  column  of  the  matrices  J  and  $q, ,  respectively.  In 
another  combined  approach,  the  actuator  loads  are  expressed  in  terms  of 
which  is  also  obtained  using  numerical  methods  during  the  evaluation  process^ 

Symbolic  expressions  for  the  torques  actuating  the  3-DOF  parallel  manipula¬ 
tor  are  identical  to  those  derived  by  hand  in  [14].  The  explicit  expressions  are  too 
lengthy  to  be  displayed  here2. 


TABLE  2.  Computational  efficiency  for  one  inverse  dy¬ 
namic  analysis  (333-MHz  Pentium  II) 


Approach 

|  Flops 

CPU  [ms] 

direct  symbolic 

967 

6.0 

pseudo-variable 

871 

6.1 

implicit  symbolic 

879 

7.6 

symbolic/numcric  (dummy  J) 

923 

15.4 

symbolic/numcric  (dummy  3>“dl) 

1235 

19.8 

The  CPU  time  and  number  of  flops  required  for  one  inverse  dynamic  evalu¬ 
ation  of  the  three  driving  torques  are  shown  in  Table  2.  The  kinematic  solution, 

2  Available  upon  request,  for  both  the  3-DOF  manipulator  and  the  Gough-Stewart  platform. 
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performed  prior  to  the  dynamic  analysis,  is  not  counted.  It  can  be  seen  that  the  di¬ 
rect  symbolic  and  pseudo-variable  approaches  are  equivalent  regarding  the  CPU 
lime,  while  the  implicit  symbolic  approach  requires  about  25%  more  CPU  time. 
The  combined  symbolic/numeric  approaches  require  more  than  twice  the  CPU 
time  compared  to  the  symbolic  approaches. 

We  can  draw  the  conclusion  that,  for  problems  of  this  complexity,  the  sym¬ 
bolic  approaches  are  preferred  because  they  are  faster  than  the  numerical  ap¬ 
proaches.  Furthermore,  they  do  not  need  matrix  manipulation  capabilities  —  this 
is  advantageous  in  microprocessor-based  control  applications.  Similar  conclu¬ 
sions  have  been  drawn  for  the  6-DOF  Gough-Stewart  platform  and,  more  recently, 
for  spatial  parallel  manipulators  with  less  than  6-DOF. 

5.  Efficient  Modelling  via  Subsystems 

The  modelling  of  multibody  systems  is  greatly  facilitated  by  the  use  of  subsystem 
models.  Models  of  entire  sub-assemblies  can  be  created  and  stored  (symbolically) 
for  future  use.  For  systems  with  a  repetitive  structure,  this  can  be  very  helpful. 
In  a  time-varying  topological  situation,  e.g.  a  virtual  reality  application  in  which 
the  user  is  adding  or  removing  parts  to  their  model,  the  system  equations  can  be 
reformulated  quickly  by  focusing  attention  only  on  the  modified  subsystems. 


S2_a 


Figure  4.  Linear  graphs  of  parallel  manipulator:  conventional  and  subsystem  models 

Subsystem  models  are  particularly  well-suited  for  the  topologies  that  are  typ¬ 
ical  of  parallel  manipulators.  Each  leg  can  be  modelled  as  a  subsystem  that  is 
kinematically  decoupled  from  the  other  leg  subsystems.  This  allows  the  equations 


147 


for  kinematics  and  inverse  dynamics  to  be  generated  and  solved  in  parallel,  ei¬ 
ther  symbolically  or  numerically  on  a  parallel  computing  platform.  Graph  theory 
is  naturally  suited  to  the  modelling  of  systems  via  subsystem  models.  Although 
the  subsystem  modelling  of  electrical  circuits  was  achieved  decades  ago  using 
graph  theory,  it  has  only  recently  been  extended  to  the  nonlinear  kinematics  and 
dynamics  of  multibody  systems. 

To  demonstrate,  consider  the  3-DOF  parallel  manipulator  again.  Shown  in 
Figure  4  is  a  conventional  graph  for  the  system,  and  a  second  graph  comprised 
of  subsystems  S if>,  S2i,  and  —  one  for  each  leg.  These  subsystems  were  de¬ 
veloped  by  starting  with  a  single  link  plus  revolute  joint,  which  were  combined 
into  a  low-level  subsystem.  Two  of  these  were  then  combined  to  form  the  2-link 
subsystems  Su,,  S2i,  and  S The  constitutive  equations  for  these  subsystems  are 
systematically  obtained  using  graph-theoretic  generalizations  of  the  well-known 
Norton  and  Thevenin  theorems  from  electrical  network  theory. 

6.  Extension  to  Mechatronic  Systems 

Graph-theoretic  modelling  is  not  restricted  to  mechanical  systems;  it  has  long  been 
applied  to  electrical,  pneumatic,  and  hydraulic  systems,  and  is  easily  adapted  to 
the  modelling  of  electro-mechanical  multibody  systems  [15], 


Figure  5.  DC  motor-driven  robot  manipulator  and  linear  graph 

To  demonstrate,  consider  the  two-link  manipulator  shown  in  Figure  5  with  its 
linear  graph  representation.  The  joint  angles  6X  and  02  are  controlled  by  two  DC 
motors  which  are  powered  by  voltage  sources  V1  and  V2.  The  linear  graph  of  the 
system  contains  the  standard  mechanical  components,  the  two  voltage  sources, 
and  the  two  motors  M7  and  Mg.  Note  that  the  graph  consists  of  two  parts,  one 
for  the  mechanical  domain  and  one  for  the  electrical  domain,  and  that  the  motors 
have  edges  in  each  domain.  This  is  true  for  any  transducer  element  that  converts 
energy  between  different  domains. 
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It  was  relatively  easy  to  extend  our  graph-theoretic  symbolic  algorithms  to  the 
modelling  of  electro-mechanical  multibody  systems.  For  the  two-link  manipula¬ 
tor,  one  obtains  four  differential  equations,  two  for  each  of  the  two  domains,  in 
terms  of  9y,  02,  and  the  two  motor  currents.  These  system  equations  can  be  used 
for  find  inverse  solutions  for  the  motor  currents  required  to  drive  a  particular  tra¬ 
jectory,  or  as  the  basis  of  a  forward  dynamic  simulation  that  tests  out  different 
controller  strategies  [15]. 

7.  Conclusions 

When  combined  with  symbolic  programming,  linear  graph  theory  provides  a  very 
efficient  approach  to  modelling  the  kinematics  and  dynamics  of  flexible  multi¬ 
body  systems.  By  selecting  a  spanning  tree  for  a  graph  representation,  one  can 
define  a  set  of  coordinates  that  is  well-suited  to  the  problem  at  hand,  including 
absolute,  joint,  or  indirect  coordinates.  The  special  topologies  of  parallel  manipu¬ 
lators  can  be  exploited,  especially  if  a  subsystem  modelling  approach  is  adopted. 
Graph  theory  is  equally  applicable  to  electro-mechanical  multibody  systems. 
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1  Introduction 

In  the  simulation  of  multibody  systems  it  is  necessary  to  devise  efficient  and  versatile  formulations  for  the 
problem  in  order  to  achieve  computational  efficiency  and  accuracy  in  the  solution  of  the  problem.  The  choice  of 
the  coordinates  has  a  direct  influence  in  the  structure  of  the  equations  of  the  motion  that  describe  the  multibody 
model  and  it  can  be  another  reason  for  a  method  to  be  more  efficient  and  accurate  than  another  [1],  Cartesian 
coordinates  based  formulations  lead  to  sets  of  differential-algebraic  equations,  which  require  proper  numerical 
methods  to  ensure  the  stability  and  accuracy  of  the  solution  [2],  The  work  now  presented  is  developed  in  the 
framework  of  Cartesian  coordinates. 

The  numerical  solution  of  the  differential  equations  of  motion  is  an  approximation  of  the  exact  solution  in 
which  the  accuracy  depends  on  the  quality  of  the  initial  guess  for  the  positions  and  velocities,  ability  to  recover 
from  the  perturbations  introduced  by  the  solution  process,  aptitude  to  deal  with  redundant  constraints,  capability 
to  handle  singular  positions  for  the  multibody  system  and  eventually  the  existence  of  intermittent  and  unilateral 
constraints.  The  set  of  differential  algebraic  equations  of  motion  does  not  use  explicitly  the  position  and  velocity 
equations  associated  to  the  kinematic  constraints.  Therefore,  small  errors  in  the  state  variables  of  the  system  due 
to  the  integration  process  or  to  their  initial  guess  by  the  user  cannot  be  corrected  in  the  course  of  the  solution  of 
the  dynamic  problem.  The  strategies  generally  used  to  overcome  this  problem  are  the  coordinate  partition 
method  [3],  the  Baumgarte  stabilization  method  [4]  or  the  augmented  Lagrangian  formulation  [5], 

In  general  spatial  models  it  is  very  often  impossible  to  avoid  the  use  of  redundant  constrains  that  lead  to 
Jacobian  matrices  with  linear  dependent  rows.  Consequently,  the  system  of  equations  formed  by  the  equations  of 
motion  and  the  constraint  acceleration  equations  has  a  left-hand-side  matrix  which  is  singular  or  that  becomes 
ill-conditioned  [6].  The  application  of  formulations  that  use  generalized  inverses  of  the  system  nonsquare  matrix, 
that  result  from  the  existence  of  redundant  constraints  or  of  the  row-deficiency,  have  been  proposed  in  multibody 
dynamics  in  recent  years  [6, 7, 8, 9].  Among  these,  the  Singular  Value  Decomposition  is  suitable  to  solve  singular, 
overconstrained  or  undetermined  problems.  Kim  and  Vanderploeg  [8]  use  QR  decomposition  for  the  same 
purpose.  Based  on  the  work  by  Udwadia  and  Kalaba  [10]  a  formulation  using  the  K-U  formulation  has  been 
proposed  by  Arabyan  and  Wu  [6],  The  advantage  of  this  formulation  is  that  the  redundant  constraints  are 
handled  in  the  solution  of  the  system  equations  of  motion  and  the  problems  that  involve  singular  configurations 
and  intermittent  constraints,  associated  with  changing  the  number  of  degrees-of-freedom,  are  managed. 
However,  as  the  proposed  methodology  does  not  include  the  constraint  and  velocity  equations  it  does  provides 
any  solution  for  the  constraint  violation  problem.  Therefore,  some  technique  that  minimizes  or  eliminates  such 
constraint  violation  errors  is  still  required. 

This  paper  presents  a  discussion  on  the  use  of  the  different  methodologies  to  handle  the  constraint  violation 
correction  or  stabilization  and  the  existence  of  redundant  constraints.  Among  these  methods  the  use  of  the  K-U 
formulations  for  multibody  systems  with  holonomic  constrains  is  emphasized.  Different  forms  of  calculating 
this  pseudo-inverse  based  on  Singular  Value  Decomposition,  QR  decomposition  and  Gram-Schmidt 
orthogonalization  are  presented. 


2  Dynamic  Analysis  of  Multibody  Systems 

A  multibody  system  is  a  collection  of  rigid  and  flexible  bodies  joined  together  by  kinematic  joints  and  force 
elements  as  depicted  in  Fig.  1.  For  the  ih  body  of  the  system  q,  denotes  a  vector  containing  the  translational 
coordinates  r;,  and  a  set  of  rotational  coordinates  p,.  A  vector  of  velocities  for  a  rigid  body  i  is  defined  as 
q(  contains  a  3-vector  of  translational  velocities  f(.  and  a  3-vector  with  the  rotationl  coordinates  velocities  p  . 
Another  body  velocity  vector  defined  as  q,‘  includes  the  angular  velocities  co,  instead  of  the  rotational 
coordinates  velocities.  When  Euler  parameters  are  used  as  rotational  coordinates  the  relation  between  then- 
velocities  and  the  angular  velocities  is  given  by  2p  =Lr<o' .  The  vector  of  accelerations  for  the  body  is  denoted 
by  q, ,  the  time  derivative  of  q,  For  a  multibody  system  containing  nb  bodies,  the  vectors  of  coordinates, 
velocities,  and  accelerations  are  q,  q  and  q  that  contain  the  elements  of  q„  q,  and  qf ,  respectively,  for 
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z'=l,...,nh.  The  system  velocity  and  acceleration  vectors,  using  angular  velocities  and  accelerations  instead  of  the 
Euler  parameters  velocities  and  accelerations  are  denoted  by  q  and  q*  respectively. 


Figure  1 .  Schematic  representation  of  a  multibody  system 

The  constraint  equations  describing  the  relative  motion  between  contiguous  bodies  arise  from  the  kinematic 
joints.  The  kinematic  constraints  are  described  by  mr  independent  equations  as 

-  0  (1) 


Figure  2.  Solution  procedure  for  the  dynamic  analysis  of  multibody  systems 

The  first  and  second  derivatives  of  the  constraints  yield  the  kinematic  velocity  and  acceleration  equations, 
respectively 

$(q,t)  =0  ■  <E>qq  =  v  (2) 

<X>(q,q,t)=0  =  ®qq'  =  Y  (3) 

where  <E>q  is  the  Jacobian  matrix  of  the  constraints.  The  equations  of  motion  for  the  system  of  rigid  bodies  are 
written  [14] 

Mq  +  <t>qrA,  =  g  (4) 

where  M  is  the  inertia  matrix,  X  is  a  vector  of  unknown  Lagrange  multipliers,  and  g=g(qq)  contains  the  forces, 
moments  and  gyroscopic  terms. 

Equations  (3)  and  (4)  form  a  system  of  differential-algebraic  equations  that  must  be  solved  together  to  obtain 
the  accelerations  and  Lagrange  multipliers.  This  system  is 


'm 

< 

q*1 

V 

0 

X 

y. 

The  standard  numerical  solution  of  these  equations  proceeds  as  illustrated  in  Fig.  2.  No  special  provision  is  made 
to  correct  for  the  constraint  velocity  and  positions  violations.  Moreover,  it  is  assumed  that  the  matrix  is  not 
singular  or  ill-conditioned. 


2. 1  STANDARD  SOLUTION  OF  THE  SYSTEM  EQUATIONS  OF  MOTION 


The  system  equations  (5)  can  be  solved  by  applying  any  method  suitable  for  the  solution  of  linear  algebraic 
equations.  The  existence  of  null  elements  in  the  main  diagonal  of  the  matrix  and  the  possibility  of  ill- 
conditioned  matrices  suggest  that  methods  using  partial  or  full  pivoting  are  preferred.  None  of  these 
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formulations  help  with  the  presence  of  redundant  constraints.  The  direct  solution  of  equation  (5)  is  hereafter 
designated  by  the  Lagrange  Multiplier  Method  1  (LM1). 

2.2  DIRECT  INVERSION  OF  THE  SYSTEM  MATRIX 


The  left-hand-side  matrix  of  the  system  equations  (5)  can  be  inverted  analytically.  Equation  (4)  is  rearranged 
to  put  the  acceleration  vector  in  evidence  in  the  left-hand-side  and  the  result  is  substituted  in  equation  (3),  which 
is  also  rearranged  to  give: 

X=  (0>qMX  jXM'g-XMXr'  y  (6) 


In  these  equations  it  is  assumed  that  the  multibody  model  does  not  include  any  body  with  null  mass  or  inertia  so 
that  the  inverse  of  the  mass  matrix  M  exists.  The  substitution  of  equation  (6)  in  equation  (4)  provides  the 
expression  for  the  system  accelerations  written  as 


q*  =[M-’  -  M-I<I>qr  (<J>qM''®qr )"'  <DqM''  ]  g  +  M_l<t>qr (®qM'1<Bj)7' )"'  y 
Equations  (6)  and  (7)  are  now  rearranged  in  a  compact  form  and  written  as 
'[M-1  -  MX (®qM'<l>qr )-' ®qM-' ]  MXXMX)-' 


(omX)Xm-1 


-XM  X)'1 


(7) 


(8) 


The  matrix  in  the  right-hand  side  of  equation  (8)  is  the  inverse  of  the  system  matrix  that  appears  in  equation 
(5).  The  solution  process  enunciated  by  equation  (8)  is  referred  to  as  the  Lagrange  Multiplier  Method  2  (LM2). 


3  Solution  Methods  To  Deal  With  Constrains  Violations 

The  initial  conditions  and  the  integration  of  the  velocities  and  accelerations  of  the  multibody  system 
introduce  some  errors  in  the  new  positions  and  velocities  obtained.  This  is  due  to  the  finite  precision  of  the 
numerical  methodologies  and  to  the  constraint  and  velocity  equations  not  appearing  anywhere  in  the  solution 
procedure  outlined  in  Fig.  2.  Therefore,  methods  able  to  eliminate  errors  in  the  constraint  or  velocity'  equations 
or,  at  least,  keep  such  errors  under  control  must  be  implemented. 

3 . 1  B AUMGARTE  STABILIZATION  METHOD 

The  second-order  equations,  such  as  equation  (3)  are  unstable.  Small  perturbations,  such  as  the  numerical 
errors  introduced  by  the  integration  process,  cannot  be  corrected  naturally  and  they  only  tend  to  be  amplified. 
The  solution  is  to  introduce  feedback  terms  that  penalize  the  system  response  with  any  violation  on  the  constraint 
or  velocity  equations  [4].  Therefore,  the  right-hand  side  of  equation  (3)  is  modified, 

®qq‘  =  y-lati-p1®  (9) 

where  a  and  /?  are  positive  constants  that  weight  the  violations  of  the  velocity  and  constraint  equations 
respectively.  These  constants,  for  a  multibody  system  made  of  rigid  bodies,  are  values  in  the  range  of  1-10, 
being  a  ,  fi  =  5  a  value  often  used  [  1  ]. 

The  use  of  the  Baumgarte  stabilization  method  is  done  by  using  equation  (9)  instead  of  equation  (3)  during 
the  system  of  equations  solution  process.  It  should  be  noted  that  the  method  does  not  correct  the  constraint 
violations  but  simply  keeps  them  under  control. 

3.2  COORDINATE  PARTITIONING  METHOD 

Based  on  the  original  work  by  Wehage  and  Haug  [3],  the  coordinate  partition  method  eliminates  completely 
the  errors  of  the  velocities  and  positions  that  would  otherwise  accumulate  during  the  integration  process.  This 
method  requires  that  the  sets  of  independent  and  dependent  coordinates  are  first  identified.  Then,  only  the 
independent  accelerations  and  velocities  are  integrated  and  the  dependent  quantities  are  calculated  using 
partitions  of  the  velocity  and  constraint  equations. 

3.2. 1  Automatic  Selection  of  the  Independent  Coordinates 

The  definition  of  the  dependent  and  independents  coordinates  can  be  automatic  by  using  a  matrix 
factorization  technique,  such  as  the  Gaussian  elimination  with  full  pivoting.  For  a  multibody  system  with  m 
constrains  and  n  coordinates  the  Jacobian  is  an  m  x  n  matrix  and  the  order  of  the  columns  of  the  matrix 
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corresponds  to  the  order  of  elements  of  vector  q.  Consider  a  m  *  n  matrix  A  for  which  the  factorization  results  in 
the  following  form 

m-k  n-(m-k ) 


B  R  }m-k 

S  D 


(10) 


where  it  is  found  that  there  are  k  redundant  rows  in  the  matrix  and  m-k  dependent  constraints.  As  a  result  of  the 
hill  pivoting  procedure  used  the  k  redundant  constraints  end  in  the  factorized  matrix  bottom  rows.  The  sub 
matrix  B  is  a  ( m-k)x(m-k )  non-singular  matrix  associated  to  the  dependent  coordinates,  and  R  is  the  sub  matrix 
(m-k)x(n-m+k)  associated  to  the  independent  coordinates. 

In  what  follows  let  it  be  assumed  that  A  represents  the  Jacobian  matrix  4>q.  Without  loss  of  generality,  let  it 
be  assumed  in  what  follows  that  there  are  no  redundant  constraints  in  the  multibody  model,  or  that  these  have 
been  identified  and  eliminated.  In  this  case  the  Jacobian  matrix  can  be  partitioned  into 

01) 

that  has  the  same  form  of  the  sub-matrix  [B  R]  of  equation  (10).  Equation  (11)  implies  the  partition  of  the 
coordinate  vector  into  vectors  of  dependent  and  independent  coordinates,  denoted  by  u  and  v  respectively.  This 
coordinate  partition  also  implies  the  partition  of  the  velocity  and  acceleration  vectors  given  as  q  =  [ur  vr]  and 
q  =  [iir  vr]  respectively. 


3.2.2  Evaluation  of  the  Dependent  Coordinates  and  Velocities 


Let  it  be  assumed  that  the  vector  of  system  accelerations  is  calculated  through  the  use  of  equation  (5)  or  (8).  The 
integration  vector  y ,  appearing  in  Fig.  2,  only  includes  the  independent  coordinates  and  it  is  written  as 

y  =  [vr  vr]r  (12) 

which  after  integration  results  in  vector  y  =  [vr  \T  ]  . 

The  dependent  velocities  and  positions  are  calculated  using  the  velocity  and  constraint  equations 
respectively.  To  evaluate  the  dependent  velocities  let  equation  (2)  be  partitioned 

3>uu+<I>vv  =  v  (13) 

The  dependent  velocities  u  are  evaluated  by  solving  the  system  of  equations 

=  -3>vv  +  v  (14) 

The  dependent  positions  are  obtained  through  the  solution  of  the  constraint  equations  given  the  independent 
coordinates,  this  is, 

«*(u,v,0  =  0  (15) 

The  Newton-Raphson  method  is  used  for  the  solution  of  equation  (15)  to  obtain  the  dependent  positions  u.  To 
achieve  convergence  some  reliable  estimates  must  be  provided  for  these  coordinates.  A  good  estimative  for  u'  at 
time  i,  to  start  the  iterative  solution  procedure,  is  evaluated  using  the  information  from  the  previous  time  C!  as 
[1] 

u'  =u‘~'  +hu‘~l  +  0.5h2ii'~'  (16) 

where  h  is  the  integration  time  step  from  t‘  to  t'~' . 


3.3  AUGMENTED  LAGRANGIAN  FORMULATION 


The  Augmented  Lagrangean  formulation  is  a  methodology  that  penalizes  the  constraint  violations,  very  much 
in  the  same  form  as  the  Baumgarte  stabilization  method  [4],  However,  this  is  an  iterative  procedure  that  presents 
a  great  number  of  advantages  relative  to  other  methods  because  it  involves  the  solution  of  a  smaller  set  of 
equations,  it  handles  redundant  constraints  and  it  can  still  deliver  accurate  results  in  the  vicinity  of  singular 
configurations.  The  Augmented  Lagrangian  formulation  consists  in  solving  the  system  equations  of  motion, 
represented  by  equation  (5),  by  an  iterative  process.  Let  index  i  denote  the  ilh  iteration.  The  evaluation  of  the 
system  accelerations  in  a  given  time  step  starts  as: 

Mq*  =  g  0'  =  0)  (17) 

The  iterative  process  to  evaluate  the  system  accelerations  proceeds  with  the  evaluation  of 
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(18) 


Mq‘tl  =  g 

where  the  generalized  mass  matrix  M  and  load  vector  g  are  given  by 

M  =  M  +  <Dqr  a<I>q 

g  =  Mq*  +  <Dqr a(y,  -  2co|i4>qq;  -  to2®, ) 

In  equation  (19)  the  mass  matrix  M,  the  Jacobian  matrix  and  the  right-hand  side  of  the  acceleration  equations 
y  are  the  same  as  those  used  in  equation  (5).  The  penalty  terms  a  ,  (i  and  co  ensure  not  only  that  the  constraint 

violations  feedback  are  accounted  for  during  the  solution  of  the  system  equations.  The  iterative  process 
continues  until 

||q*+, -q*||<e  (20) 

The  Augmented  Lagrangian  formulation  involves  the  solution  of  a  system  of  equations  with  a  size  equal  to 
the  number  of  coordinates  of  the  multibody  system.  The  mass  matrix  M  is  generally  positive  semi-definite  but 
the  leading  matrix  of  equation  (18)  M  +  <Dqra<I>q  is  always  positive  definite  [5],  Even  when  the  system  is  close  to 
a  singular  position  or  when  in  presence  of  redundant  constraints  the  system  of  equations  can  still  be  solved. 


4  Methods  to  Deal  With  Redundant  Constraints 

In  many  practical  situations  the  multibody  systems  models  include  redundant  constraints.  In  some  multibody 
systems  it  also  happens  that  some  constraints  are  either  intermittent  or  they  vanish.  Several  improved 
formulations,  using  the  Moore-Penrose  generalized  inverse,  that  are  suitable  for  these  kind  of  multibody 
systems,  are  revised  here. 


4. 1  THE  MOORE-PENROSE  GENERALIZED  INVERSE 


Let  the  accelerations  of  the  unconstrained  multibody  system  be  quac  =  M''g  ,  where  it  is  assumed  again  that 
all  bodies  of  the  system  have  non-null  masses  and  inertias.  Equation  (7)  can  now  be  rearranged  as 

q‘  =C  +  MX(®qMX)',(r-4»,C)  (21) 


Let  the  inverse  of  the  mass  matrix  be  written  as  M  '1  =  M M’^ .  Equation  (21)  becomes 

q*  =  C  +  M-"2  (m'X  JXM-M-'Xr’  (t  -  «•  C )  (22) 

An  auxiliary  variable  D  =  3>qM  l/2  is  defined  that  upon  substitution  in  equation  (22)  leads  to 


q^C+M'^W  r'fy-XC) 

The  Moore-Penrose  generalized  inverse  of  D,  denoted  by  D4  has  the  properties  [6] 

DD*D  =  D 
DDD4  =D 


(23) 


(24) 


being  D+D  and  DD+  both  symmetric  matrices.  Consequently 

D7(DDr) 1  =  Dt  (d+  )'  D+  =  (D+  D)7  D4  =DfDD*  =  D4  (25) 

The  result  expressed  by  equation  (25)  is  substituted  in  equation  (23)  leading  to 

q  =  C  +  M',,2D+  (y  ~  ®qC„c )  (26) 

The  solution  of  equation  (16),  hereafter  designated  by  MPI,  always  exists  because  the  Moore-Penrose 
pseudo-inverse  exists  even  when  the  inverse  of  the  leading  matrix  of  equation  (5)  does  not  exist.  This  means 
that  in  the  presence  of  redundant  constraints  or  in  the  presence  of  constraints  that  vanish  instantaneously,  such  as 
the  unilateral  constraints,  the  pseudo-inverse  matrix  D+  still  exists. 
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4.2  COMPUTATION  OF  THE  GENERALIZED  INVERSE 


4.2.1  Single  Value  Decomposition 

The  calculation  of  the  system  accelerations  using  equation  (26)  assumes  that  the  pseudo-inverse  matrix  D+ 
can  be  calculated.  Let  D  be  a  MxN  nonsquare  matrix.  Its  singular  value  decomposition  (SVD)  leads  to 

D=USVr  (27) 

where  U  and  V  are  M*M  and  N*N  square  orthogonal  matrices  respectively.  The  nonsquare  matrix  S  has 
nonzero  elements  only  on  its  diagonal  and,  therefore,  the  calculation  of  its  pseudo-inverse  S+  is  trivial  [11).  The 
pseudo-inverse  of  D  is 

D+  =  V  S+Ur  (28) 

where  the  relations  Ur=U';  and  Vr=V;,  valid  for  orthogonal  matrices,  have  been  used. 

4.2.2  Gram-Schmidt  Orthogonalization 

The  Gram-Schmidt  orthogonalization  process  (G-S)  can  be  used  to  compute  the  pseudo-inverse  matrix  D+. 
With  this  method  matrix  D  is  decomposed  in  [1 1) 

D=Q  R  (29) 

where  Q  is  a  MXN  matrix  whose  columns  are  orthogonal  to  each  other,  i.e.,  QT  Q  =  I,  and  R  is  a  NXN  upper 
triangular  matrix.  The  computation  of  the  pseudo-inverse  is  then  obtained  as 

D+  =  R"'Qr  (30) 

The  use  of  the  Gram-Schmidt  orthogonalization  requires  that  the  columns  of  matrix  D  are  all  independent. 


5  Application  Examples 

The  virtues  and  shortcomings  of  the  different  methods  proposed  are  presented  with  their  application  to  several 
simple  mechanical  systems,  both  in  kinematic  and  dynamic  analysis. 

5 . 1  KINEMATIC  ANALYSIS  OF  A  PLANAR  FOUR  BAR  LINKAGE 

Typically  the  solution  of  a  kinematic  analysis  consists  in  first  solving  equation  (1)  using  the  Newton- 
Raphson  method  and  after  solving  the  linear  systems  of  equations  (2)  and  (3).  To  use  equation  (26)  for  the 
kinematic  analysis  the  system  mass  matrix  becomes  the  identity  matrix  and  the  forces  in  the  system  are 
eliminated.  The  result  is 

q  =D+  y  (31) 

The  vector  of  accelerations  is  integrated  together  with  the  velocities  to  obtain  new  velocities  and  positions, 
using  the  sequence  depicted  by  Fig.  2.  This  procedure,  by  itself,  does  not  ensure  that  the  constraint  equations  are 
fulfilled.  Therefore,  the  use  of  a  methodology  that  stabilizes  the  constraint  violations  is  still  required. 

Consider  the  planar  four-bar  linkage,  shown  in  Fig.  3,  with  a  =  b  =  0.5  m  where  the  bar  2  has  a  constant 
angular  velocity,  co^  —  124.8  rad/s.  Though  the  motion  of  the  four-bar  linkage  is  planar,  the  system  model  made 
with  two  revolute  joints,  in  points  A  and  D,  and  two  universal  joints,  in  points  B  and  C,  is  three  dimensional. 

The  6  bodies  that  make  the  system  model  account  for  24  coordinates  while  the  revolute  and  universal  joints 
the  ground  body  and  the  driving  constrains  account  for  25  constraints.  The  model  has  2  redundant  constraints. 
The  existence  of  the  redundant  constraint  can  be  eliminated  with  the  substitution  of  the  universal  joints  by  a 
spherical  joint.  Two  initial  positions  for  the  initial  orientation  of  body  2  are  considered:  body  2  aligned  with  X, 
i.e.,  61  =  mt ;  02  =  n/ 4  .and  02  =  n/2  .  The  system  is  simulated  using  alternatively  LM2,  ALF  and  MPI  methods  to 
calculate  the  accelerations.  The  pseudo-inverse  is  calculated  by  using  the  singular  value  decomposition  or  the 
Gram-Schmidt  orthogonalization  methods.  The  Baumgarte  stabilization  and  the  coordinate  partitioning  methods 
are  also  used  when  equations  (7)  and  (26)  are  applied  when  the  system  required  that  the  constraint  violations  are 
kept  under  control.  The  comparison  of  the  results  using  the  different  methodologies,  and  their  combinations,  is 
presented  in  Table  1. 
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Figure  3.  Parallel  four-bar  linkage 

The  results  presented  in  table  1  shows  that  method  LM2  fails  due  to  the  presence  of  redundant  constraints 
and  it  presents  numerical  difficulties  when  singular  positions  appear.  Method  MPI  leads  to  the  correct  solution 
of  the  system  accelerations  but  the  use  of  constraint  stabilization  or  coordinate  partition  methods  is  required  in 
order  to  ensure  that  the  system  constraint  equations  are  fulfilled.  Figure  4  shows  the  constraint  violation  for  GS 
and  SVD  technique  without  the  coordinate  partitioning  method  and  in  the  Fig.  5  the  same  type  of  results  are 
presented  when  the  coordinate  partitioning  is  used. 


TABLE  1 .  Comparison  of  the  outcome  in  the  use  of  different  methods  in  the  four-bar  linkage 


Methods 

0,  =nn 

Initial  position 

0,  =  n  /  4 

0,  =  rr/2 

LM2 

Fail  (M.S.) 

Diverge(t=0,044s) 

Diverge(t=0,063s) 

LM2+Baumg.  Stab. 

Fail  (M.S.) 

Divcrge(t=0,044s) 

Fail  (M.S.,t=0,03) 

LM2+Coord.  Part. 

Fail  (M.S.) 

Converge 

Fail  (M.S.,t=0,27) 

ALF 

Const.Viol.(I2) 

Const.  Viol. (9) 

Const.Vio!.(9) 

MPI(SDV) 

Diverge(t=Os) 

Diverge(t=0,044s) 

Diverge(t=0,03s) 

MPI(SDV)+  Baumg.  Stab. 

Diverge(t=Os) 

Divcrge(t=0,044s) 

Divergc(t=0,063s) 

MPl(bDV)+L'oord.  Part. 

Diverge(t=Os) 

Converge 

Converge 

MPl(G-S) 

Diverge(t=Os) 

Diverge(t=0,044s) 

Diverge(t=0,03s) 

MPI(G-S)+  Baumg.  Stab. 

Diverge(t=Os) 

Diverge(t=0,044s) 

Diverge(t=0,063s) 

MPl(U-S)+Coord.  Part. 

Diverge(t=Os) 

Converge 

Converge 

Planar  Four  bar  Linkage 


-C23(MPI(GS)) 


Figure  4.  Violation  constrains  number  23  without  the  coordinate  partitioning 

Planar  Four  Bar  Linkage  ^ 

K  - C23(M  PI(GS)+CP) 


Time 
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Figure  5.  Violation  constrains  number  23  with  the  coordinate  partitioning 


5.2  DYNAMIC  ANALYSIS  OF  A  PLANAR  SLIDER  CRANK 

A  planar  slider-crank,  shown  in  Fig.  6,  for  which  some  singular  configurations  are  achieved  during  the 
dynamic  analysis  is  presented  here.  The  mechanism  is  driven  by  an  applied  moment  of  100  Nm.  A  first  model 
has  the  linkages  2  and  3  with  the  same  size,  i.e.,  a=b=0.308  m,  reaches  singular  configurations,  while  the  second 
model  considers  these  linkages  with  different  lengths,  more  specifically  a=0.304  m  and  b=0.405  m.  Both  models 
are  built  by  including  revolute,  spherical  joint,  translation  joints  and  a  ground  body,  which  corresponds  to  24 
coordinates  and  24  kinematic  constraints,  being  1  constraint  redundant. 


to  =  124.8  rad  s' 


vZssssssssssssssssssssssssssssssss/A 


Figure  6.  Planar  Slider-Crank 

The  simulation  of  the  mechanism  when  the  coordinate  partitioning  method  is  used  diverges  when  the  singular 
positions  are  reached.  The  formulation  using  the  pseudo-inverse  is  calculated,  either  by  G-S  or  SVD 
factorization,  provides  results.  As  shown  in  Fig.  7,  the  dynamic  response  diverges,  as  the  mechanism  motion 
follows  two  different  branches. 
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Figure  7.  Crank  angular  velocity  and  the  Singular  Positions 

To  verify  that  the  branching  of  the  slider  crank  motion  is  due  to  the  singular  position  reached,  a  new  slider 
crank  model  with  a  connecting  rod  different  from  the  crank  is  modeled.  In  this  case  the  dimensions  of  the  crank 
and  connecting  rod  are  a  =  0.304  m  and  b  =  0.4048  m.  As  observed  in  Fig.  12  only  with  LM1  and  GS 
formulations  provide  similar  results,  when  no  coordinate  partitioning  is  used.  The  LM2  fails  because  the  matrix 
is  Singular  and  the  ALF  formulation  fails  because  the  violation  constrains  is  toOolarge. 
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Figure  8.  Crank  angular  velocity  without  singular  positions 

When  the  coordinate  partitioning  is  used  in  the  analysis  of  the  multibody  model,  the  numerical  results, 
presented  in  Fig.  9  ,  are  slightly  different  in  this  case  as  the  constraint  violations  are  prevented. 
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Figure  9.  Crank  angular  velocity  with  coordinate  partitioning 


6  Conclusions 


General  formulations  for  the  dynamic  and  kinematic  analysis  rigid  mechanical  systems  have  been  reviewed 
here.  First,  the  violation  of  the  constraint  and  velocity  equations,  that  arise  from  the  integration  of  the 
differential-algebraic  equations,  associated  to  the  multibody  models  described  by  Cartesian  coordinates,  can  be 
handled  by  using  constraint  stabilization  methodologies,  such  as  the  Baumgarte  stabilization  method  or  the 
augmented  Lagangian  formulation,  or  by  using  the  coordinate  partitioning  method.  It  was  shown  that  the  use  of 
the  coordinate  partition  method  requires  that  a  set  of  independent  coordinates  is  set  beforehand.  The 
factorization  procedures  that  use  on  full  pivoting  not  only  provide  the  necessary  tools  for  the  coordinate 
partitioning  but  also  identify  the  redundant  constraints  of  the  model.  Therefore,  in  the  process  of  using  the 
coordinate  partitioning  method  the  elimination  of  the  redundant  constraints  comes  for  free.  Second,  the  existence 
of  redundant  constraints  or  singular  configurations  for  the  multibody  system  can  be  handled  by  applying  a 
procedure  that  makes  use  of  the  Moore-Penrose  pseudo-inverse.  This  pseudo-inverse  can  be  calculated  using  a 
singular  value  decomposition  or  by  applying  the  Gram-Schmidt  orthogonalization  procedure. 

By  using  several  simple  spatial  multibody  systems  the  relative  efficiency  and  suitability  of  the  different 
methods,  and  of  their  combination,  was  tested.  For  all  proposed  applications  it  was  observed  that  the  control  of 
the  constraint  violation  is  fundamental  for  long  running  times.  It  was  also  observed  that  the  elimination  of  the 
redundant  kinematic  constraints,  after  they  are  identified  by  using  the  factorization  procedure,  is  more  efficient 
than  the  use  of  the  pseudo-inverse  methodologies.  However,  in  the  case  of  singular  positions  of  intermittent 
constraints  the  use  of  the  Moore-Penrose  pseudo-inverse  is  fundamental. 
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In  most  applications  of  multibody  analysis,  it  is  desirable  to  reduce  the  number  of  equations 
of  motion  in  order  to  improve  the  computational  efficiency.  This  becomes  even  more 
important  when  the  model  contains  deformable  bodies.  Therefore  it  would  be  desirable  to 
reduce  the  number  of  the  deformable  body  degrees-of-freedom  without  too  much  loss  in 
the  accuracy  of  the  results.  In  this  manuscript  we  present  the  equations  of  motion  for  a 
simple  but  general  rigid-flexible  multibody  system  in  a  semi-abstract  form  in  order  to  keep 
our  focus  on  reduction  techniques.  Several  model  reduction  techniques  are  reviewed  and 
the  advantages  and  disadvantages  of  each  process  are  briefly  discussed. 

1.  Introduction 

One  interesting  issue  in  multibody  dynamics  is  computational  efficiency  and  real-time 
simulation.  This  issue  becomes  even  more  serious  when  a  multibody  model  contains 
deformable  bodies.  Although  a  defonnable  body  may  only  represent  small  linear 
deflections,  the  overall  multibody  equations  must  be  treated  as  a  nonlinear  system.  Due  to 
this  particular  issue,  it  is  highly  desirable  to  reduce  the  number  of  degrees-of-freedom. 

In  the  past  two  decades  researchers  have  proposed  a  variety  of  model  reduction 
techniques.  Each  technique  is  based  on  certain  assumptions;  consequently,  approximation 
error  is  introduced  into  the  model.  Therefore,  it  is  important  to  understand  the  differences 
among  these  methods  and  apply  them  where  appropriate.  In  this  manuscript  we  review 
several  model  reduction  methods  and  discuss  their  differences. 

It  is  assumed  that  the  reader  has  some  familiarity  with  the  equations  of  motion  for  a 
deformable  body.  These  equations  have  been  stated  without  proof.  In  order  to  concentrate 
on  concepts  and  not  to  be  distracted  by  the  complex  form  of  equations,  we  assume  that  a 
node  in  a  finite -element  model  exhibits  only  translational  degrees-of-freedom.  Elimination 
of  the  rotational  degrees-of-freedom  does  not  make  the  discussion  any  less  general.  The 
rotational  degrees-of-freedom  can  be  added  to  these  formulations  if  necessary. 

Due  to  page  limitation,  no  literature  review  has  been  provided.  Most  of  the  topics 
discussed  in  this  manuscript  could  be  referenced  to  more  than  one  source,  but  in  order  to 
save  space  the  list  of  references  has  been  kept  to  a  minimum. 

2.  Notation 

In  this  manuscript  the  matrix  notation  is  used  in  order  to  keep  our  attention  on  concepts 
without  any  loss  of  details.  The  reader  should  find  the  notation  to  be  effective  in  multibody 
formulation  of  equations  of  motion.  The  following  nomenclature  is  used: 
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Right  superscripts: 

b  boundary  node 

d  deleted  (truncated)  mode 

k  kept  mode 

m  master  (kept)  node 

s  slave  (deleted)  node 

u  unconstrained  (free)  node 

Right  subscripts: 
c  constrained 

/  free-free  (unconstrained) 

G  Guyan 

r  index  of  a  rigid  body 

Left  superscripts: 

'  (prime)  components  are  described  in  the  body-fixed  frame 
Over-scores: 

~  (tilde)  transforms  a  3-vector  to  a  skew-symmetric  matrix 
A  (hat)  stacks  vertically  3-vectors  or  3  x  3  skew-symmetric  matrices 

(bar)  repeats  a  3  x  3  matrix  to  form  a  diagonal  or  block-diagonal  matrix 

The  right  superscripts  and  subscripts  are  self-explanatory.  The  left  superscript  “prime”  is 
of  great  importance— it  indicates  that  an  entity  is  described  in  terms  of  its  body-fixed 
components.  Therefore,  an  entity  without  a  “prime” Jeft  superscript  refers  to  the  global 

components.  Assume  that  I  is  a  3x3  identity  matrix,  b1  is  a  3x3  skew-symmetric  matrix 

for  i=J,  ...,  n,  and  A  is  a  3x  3  rotational  transformation  matrix.  The  over-scores  “A”  and 
are  used  as: 


Y 

a 

br 

i 

'a 

i 

>  b  = 

- > 

c 

_ i 

,  1  = 

i 

,  A  = 

A 

3.  Equations  of  Motion  for  A  Deformable  Body 

In  this  section  we  state  the  equations  of  motion  for  a  deformable  body  first  without 
considering  on  how  a  reference  frame  is  attached  to  the  body.  The  equations  of  motion  are 
initially  stated  for  a  structure  without  any  rigid-body  motion.  Then,  the  structure  is  allowed 
to  deform  and  undergo  rigid-body  translation  and  rotation.  Finally,  the  so-called  mean-axis 
conditions  are  used  to  attach  a  reference  frame  to  the  moving  deformable  body. 

3.1.  EQUATIONS  OF  MOTION  IN  NODAL  COORDINATES 

Assume  that  a  deformable  body  is  described  by  nnodes  nodes.  The  positions  of  the  nodes 
are  defined  with  respect  to  a  non-moving  body-fixed  h,  -q  —  £  frame  as  shown  in  Fig.  1 . 
The  mass  and  stiffness  matrices,  M  and  'K,  are  ndof  x  ndof  each  where  ndof  =  3  xnrodts. 
The  equations  of  motion  for  this  body  are  written  as 

M  8  =  f  -  K  8  (3,1) 

where  f  and  8  are  each  ndoj  arrays  containing  external  forces  and  nodal  translational 
deflections  respectively.  We  are  reminded  that  the  left  superscript  “prime”  indicates  that  a 
vector,  an  array,  or  a  matrix  is  described  in  terms  of  its  components  in  the  ^  -q  -  £  frame. 
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It  should  be  noted  that  the  stiffness  matrix  K  has  a  rank  deficiency  of  six  since  we  have 
not  yet  imposed  any  boundary  conditions. 


Figure  1 .  A  deformable  body  and  its  body-fixed  and  global  reference  frames. 


We  introduce  another  nonmoving  coordinate  frame,  x-y-z,  that  does  not  coincide  with 
S-ri-C.  A  3x3  rotational  transformation  matrix,  A,  between  the  two  non-moving 
frames  is  defined.  Components  of  any  vector  in  the  £  -r|  -  £  frame  can  be  transformed  to 

the  x-y-z  frame;  e.g.,  8'  =  A  8'.  Using  the  block-diagonal  matrix  A,  and  the 

transformations  8  =  ATS  and  8=ATS,  Eq.  3.1  is  expressed  in  terms  of  the  x-y-z 
components  of  its  entities  as 

M8  =  f  -K8  (32) 

where, 

M  =  AMAt  (3. 3. a),  K  =  AKAt  (3.3.b),  f  =  Af  (3.3.c) 

Most  mass  matrices  have  the  characteristics  to  yield  M=  M,  but  in  general  this  may  not  be 
the  case1.  Equations  3.1  or  3.2  are  valid  only  if  there  is  no  rigid  body  motion;  i.e.,  the 
nodal  accelerations  are  only  due  to  structural  deformation. 

Now  we  allow  the  flexible  body  and  its  ^  -rj  —  ^  frame  to  move  with  respect  to  the  x-y- 
z  frame.  For  a  flexible  body  with  nnodes  nodes,  as  shown  in  Fig.  1,  we  can  write  ndof 
equations  in  nJof  accelerations  as 


Md=  f-K8  (34) 

The  array  of  accelerations,  d ,  contains  the  absolute  nodal  accelerations  described  with 
respect  to  the  x-y-z  frame.  Hence,  the  external  and  structural  forces  are  also  expressed  in 
terms  of  their  components  in  the  same  frame.  The  mass  matrices  and  the  force  arrays  in 
Eqs.  3.2  and  3.4  are  the  same.  The  only  difference  is  in  the  acceleration  arrays. 

The  absolute  position  of  a  typical  node  i,  as  shown  in  Fig.  1,  is  expressed  as: 

d'  =  r+  b'  =  r+  s'  +  8'  (3-5) 

The  absolute  velocity  and  acceleration  of  the  node  are  expressed  as: 

d'  =  r-  b'co  +  8'  (3.6) 

d'  =  r-b‘cb  +8'  + w'  (3.7) 


1  For  most  lumped  and  consistent  mass  matrices  with  only  translational  nodal  degrees-of-freedom,  M=  M. 
In  certain  cases,  for  example  when  the  mass  matrix  is  condensed  through  Guyan  reduction,  M*M. 
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where  co  and  a)  are  the  angular  velocity  and  acceleration  of  the  body-fixed  frame,  and 

w' =  axob'  +  2ftj5'  (3.8) 

The  position,  velocity,  and  acceleration  of  all  the  nodes  are  written  in  stack  form  as: 

d  =  Ir  +  b  (3.9) 


(3.10) 


d  =  Ir-bco  +  8=  I  -b  In© 


d  =  ir-bco+8  +  w=  i  -b  iNcb U<5©b  +  2©5 


We  substitute  Eq.  3.1 1  into  Eq.  3.4  to  get 


(3.11) 


MI  -b  1  |©|=f-Mw-K5 
5 


(3.12) 


Equation  3.12  represents  niof  equations  in  ndof  +  6  accelerations.  Assuming  that  the 

external,  structural,  and  velocity  dependent  forces  are  known,  Eq.  3.12  cannot  be  solved 
for  the  accelerations  since  there  are  more  unknowns  than  the  equations. 

Equation  3.12  can  also  be  written  in  a  different  form  if  we  pre-multiply  it  by  the 
transpose  of  the  coefficient  matrix  of  Eq.  3.10.  This  new  form  is 


-bTMi 


-ITMb 


-Mb 


-bTM  \(b 


Ij(f-Mw) 
-bT(f-  Mw) 
f-Mw-K8 


(3.13) 


where, 


ItMI  =ml  (IT'MI  =  /nI)  (3. 14. a),  bTMb  =  J  ('bT'Mb='j)  (3.14.b) 

*K5  =  0  (IT  K  8  =  0)  (3.14.c),  bTK8  =  0  (bTK8  =  0)  (3.14.d) 

In  Eqs.  3. 14. a  and  3.14.b,  m  and  J  represent  the  total  mass  and  the  instantaneous 
rotational  inertia  matrix  of  the  body.  In  Eq.  3.13  we  have  also  used  the  two  identities  given 
in  Eqs.  3.14.C  and  3.14.d.  These  identities  state  that  the  sum  of  internal  structural  forces 
and  moments  is  equal  to  zero. 

Equation  3. 13  can  also  be  transformed  to  other  forms.  For  example,  we  can  express 
the  nodal  deformation  array  with  respect  to  the  body-fixed  frame: 

A  T  . 

ml  -ITMb  ItMA  [rl  [iT(f-Mw) 

-bTMI  J  ^  -bTMA  -  d)  •=  -  -bT(f- Mw)  >  (3.15) 

AtMI  -ATMb  M  '8  f-Mw-K8 

Equations  3.12,  3.13,  and  3.15  are  different  representations  of  Eq.  3.4.  Although  so 
far  we  have  not  discussed  how  to  attach  a  reference  frame  to  the  body,  let  us  assume  that 
the  modal  deflections  are  known;  therefore,  the  array  of  forces  at  the  right-hand  side  of 
these  equations  can  be  determined.  Equation  3.4  contains  ndof  equations  that  can  be  solved 
to  determine  ndof  unknown  accelerations.  Equation  3.12  contains  ndof  equations  in  ndof+ 
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6  unknown  accelerations  and  therefore  they  cannot  be  solved  for  the  accelerations. 
Equation  3.13  or  3.15  each  contains  ndof+  6  equations  in  ndof+  6  unknown  accelerations. 
However,  since  in  each  set  of  equations  there  are  six  redundant  equations,  they  cannot  be 
solved  for  the  accelerations  either. 

3.1.1.  Boundary  and  Unconstrained  Nodes 

In  a  multibody  system,  a  flexible  body  is  often  connected  to  other  rigid  or  flexible  bodies. 
The  connections  are  through  kinematic  joints,  springs,  dampers,  or  other  elements.  For 
this  purpose  we  split  the  nodes  of  a  flexible  body  into  two  sets  as  shown  in  Fig.  2:  the 
boundary  nodes  having  superscript  “6”,  and  the  unconstrained  nodes  with  superscript  “u”. 
The  boundary  nodes  will  be  used  to  connect  the  deformable  body  to  other  bodies,  and  the 
unconstrained  nodes  remain  free.  Based  on  this  categorization,  all  entities  associated  with  a 
flexible  body  will  be  split  into  subsets,  for  example: 


b 


Figure  2.  Boundary  and  unconstrained  nodes. 

3.2.  BODY-FIXED  FRAME 

In  order  to  attach  a  body-fixed  frame  to  a  deformable  body,  we  need  to  define  six 
conditions.  With  these  conditions,  the  number  of  nodal  deflection  degrees-of-freedom 
becomes  ndof  -  3x  nnodes-6\  i.e.,  the  rigid-body  degrees-of-freedom  are  removed.  The 
common  procedure  in  finite  element  method  is  to  introduce  boundary  conditions  to  set  six 
of  the  nodal  deflections  to  zero.  Another  procedure  defines  six  so-called  mean-axis 
conditions  [1]. 

The  mean-axis  conditions  are  defined  at  the  velocity  level  as2 

ItM5=  0  (iT  M  S  =0)  (3.17) 


2  The  mean-axis  conditions  can  be  obtained  from  the  minimization  of  the  deformation  kinetic  energy.  The 
kinetic  energy  associated  with  the  deformation  is  expressed  as: 

T  =  ±  8tM5  =  4  (d  -  if  +  bco)T  M(d  -  if  +  bto) 

The  partial  derivatives  of  the  kinetic  energy  with  respect  to  the  translational  and  angular  velocities  of  the 
body-fixed  frame  are: 

Tr  =  -(d  -  ir  +  boo)T  M I  =  -8TM  i 
T.  =  ^(d-ir+  bco)TMb  =8TMb 

The  minimum  kinetic  energy  is  achieved  if  these  derivatives  are  set  to  zero. 
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bTM8=0  (bT,M5=0)  (3.18) 

The  time  derivative  of  these  equations  yields 

iTM5  =  0  (IT  M  5=0)  (3.19) 

bTM8=-8TM8  (  bT  M  8  =-  8T  M  5)  (3.20.a) 

The  right-hand  side  of  Eq.  3.20.a  could  be  zero  depending  on  the  characteristics  of  the 
mass  matrix.  Therefore,  the  simpler  form  of  Eq.  3.20.a  is 

bTM5  =  0  (bT  M  '5  =  0)  (3  20  b) 

Other  identities  can  be  derived  based  on  Eqs.  3.17  and  3.18.  For  example,  the  integral  of 
Eq.  3.17;  i.e.,  ItMS  =  0,  yields 

ITMb  =  bTMT  =  0  (IT  M  b=  bT  MI  =  0)  (3  2n 

This  is  known  as  the  first-moment  equation.  It  states  that  the  origin  of  the  reference  frame 
stays  at  the  instantaneous  mass  center  of  the  body. 

Substituting  Eqs.  3.19,  3.20.a,  and  3.21  into  Eq.  3.13  yields 


-Mb  M 


Or]  ^  IT(f-Mw) 

0  jd>f  =  <  -bT(f-Mw)  +  5TM5 


(3. 22. a) 


f-K8-Mw 


The  coefficient  matrix  in  Eq.  3.22.a  is  non-singular.  Therefore,  if  all  of  the  forces  are 
known,  the  equations  can  be  solved  for  the  accelerations.  If  we  use  Eq  3  20  b  in  the 
above  process  instead  ofEq.  3. 20.a,  Eq.  3.22.a  finds  the  following  form: 


ml  0 
0  J  ^ 
MI  -Mb 


0  r  Ij(f-Mw) 

0  ]  cb  i  =  •  — bT(f  —  Mw) 
M  5  f-K5-Mw 


(3.22.b) 


In  this  manuscript  we  use  Eq.  3.22.b  instead  of  Eq.  3.22.a.  This  means  that  we  make  the 
assumption  that  the  mass  matrix  has  the  required  characteristics  such  that  Eq  3  20  b  is 
Fu™ermore  depending  on  the  characteristics  of  the  mass  matrix,  some  other  terms 

on  the  right-hand  side  of  Eq.  3. 22. a  could  further  be  simplified. 

Equations  3.19  and  3.20.b  could  be  incorporated  into  Eq.  3.22.b  (or  Eq.  3.13)  using 

the  I  .?IOT3n(7P  multmlior  /  O 
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(3.23) 


^ il  \con  a'n  six  Lagrange  multipliers.  In  Eq.  3.23  the  mean-axis  conditions  at 

Rn  5  ?S10n  leve!are  exPllcltly  present  and  therefore  they  are  definitely  enforced  In 

fhrthp  rC°n^[10nS  a^e  n0t  exPllcltly  present,  therefore,  when  we  solve  Eq.  4.10b 

for  the  accelerations,  the  result  may  not  exactly  satisfy  Eqs.  3.19  and  3.20.b.  Although  the 

err0r  C0U  d  be  extremely  small,  in  the  process  of  integration  of  the  equations  of 
motion  this  error  may  accumulate  and  may  cause  numerical  instability. 
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4.  Nodal  and  Modal  Transformations 


The  number  of  nodes,  and  consequently  the  number  of  degrees-of-ffeedom  associated  with 
a  deformable  body,  may  be  too  large  for  any  realistic  simulation.  Therefore,  various 
processes  have  been  developed  to  reduce  the  number  of  degrees-of-freedom.  The 
reduction  process  may  be  performed  either  in  the  nodal  or  in  the  modal  space. 

4.1.  STATIC  CONDENSATION 


In  the  so-called  static  or  Guyan  condensation,  it  is  assumed  that  some  of  the  nodes  of  a 
finite  element  model  are  kept  and  the  rest  are  deleted  [2].  For  this  purpose,  we  use 
superscripts  m  and  s  for  the  master  (kept)  and  slave  (deleted)  nodes3.  The  structural 
equations  of  motion,  Eq.  3.1,  are  re-written  as 


Mms 

'M" 


K" 


(4.1) 


K.mm 

K™  K5 

We  now  assume  that  the  inertia  of  the  entire  structure  is  allocated  to  the  master  nodes  and 
no  external  forces  are  applied  to  the  slave  nodes;  i.e., 


(4.2) 


Ksm  K" 

where  Mc  is  the  mass  matrix  associated  with  the  master  nodes  containing  the  entire 
structural  inertia.  This  matrix  will  be  determined  as  a  function  of  the  original  sub-matrices. 
The  second  row  of  the  equations  of  motion  yields: 

Ksm  8m  +  K”  5"  =  0 

From  this  equation  we  get 

5*  =  G  8m  (4.3) 

where 

G=-  K”  '  Kfm  (4.4) 

is  known  as  the  static  condensation  matrix.  This  matrix  can  be  used  to  determine  the 
reduced  mass  and  stiffness  matrices  as: 

(4.5) 


,MG=’Mmm+'Mmi'G+'GT  'M™+'Gt  'M“'G 


K, 


wffi  ms 


(4.6) 


Matrices  Mc  and  Kc  can  now  be  used  in  any  of  the  equations  of  motion  instead  of  M 
and  K. 


4.2.  MODAL  MATRICES 

In  the  following  sub-sections  we  use  modal  data  for  different  mass  and  stiffness  matrices. 

In  general,  it  is  assumed  that  the  matrix  of  mode  shapes,  4*  ,  provides  the  following 
transformation  between  the  modal  and  nodal  coordinates: 

8  =  4*  z  (4.7) 

If  we  define  another  modal  matrix  as 

4*  =A  V  (4.8) 


3  The  boundary  nodes  are  a  sub-set  of  the  master  nodes.  The  slave  nodes  contain  some  or  all  of  the 
unconstrained  nodes. 


(4.9) 


then  we  have  another  form  of  the  transformation  equation  as 

8  =VF  z 

Equation  4.8  is  also  applicable  to  matrix  G  in  Eq  4.3. 
4.2.1.  Free-Free  Modes 


The  matrices  of  the  mode  shapes  and  modal  frequencies  obtained  from  M  and  K  are: 

[i  -s  T'J,  diag( 0,  0,  Af)  (4.10) 

In  the  matrix  of  mode  shapes,  I  and  —  s  represent  the  translational  and  rotational  rigid 
body  mode  shapes  (each  is  an  ndof  x  3  matrix),  and  f  which  is  an  ndof  x  (ndof  -  6)  matrix 
represents  the  deformation  mode  shapes.  The  diagonal  matrix  of  eigenvalues  contains  six 
zero  eigenvalues  associated  with  the  rigid  body  modes  and  the  natural  frequencies  Af . 

Note  that  the  subscript  ‘/'emphasizes  that  these  entities  correspond  to  a  free-free  structure. 
The  modal-to-nodal  transformation  equation  is  written  as 

6=^/2  (4.11) 

The  modal  stiffness  and  mass  matrices  are 

Mf=^fv Kf=V]' KVf  (4.12) 

Considering  the  partitioning  of  the  nodes  based  on  the  boundary  and  unconstrained  nodes 
Eq.  4.1 1  becomes 


(4.33) 


4.2.2.  Constrained  Modes 


Assume  that  the  boundary  nodes  are  constrained  not  to  have  any  deflections;  i.e., 
5  =  5fc  =  0.  In  this  case  sub-matrices  ’MT  and  'Kuu  are  used  to  obtain  modal  matrices 
4/c  and  Ac.  If  the  boundary  nodes  eliminate  at  least  six  degrees-of-freedom,  there  will  be 
no  zero  eigenvalues  in  Ac.  The  subscript  V’cmphasizcs  that  these  entities  correspond  to  a 
constrained  structure.  The  transformation  equation  is 

8“=vFcz  (4.14) 

The  modal  stiffness  and  mass  matrices  are  obtained  as 


Af  =  4V  MT  'i'e,  K  =  yf' K““  V. 


(4.15) 


4.2.3.  Constrained  Modes  and  Static  Condensation 


We  can  assume  that  the  deflections  of  the  unconstrained  (free)  nodes  are  expressed  in  terms 
of  the  deflection  of  the  boundary  nodes  and  the  constrained  modal  matrix  vFc  as 

'5u  =  E’8*+’4/cz 

where  E  is  a  coefficient  matrix  to  be  determined.  For  the  complete  set  of  deflections  this 
equation  is  written  as 


(4.16) 


Using  the  coefficient  matrix,  the  stiffness  matrix  is  transformed  to  modal  space  as 
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I  ET  T  K“  Kiu  10  K  +  JK.  E  +  E  (.K  +K  JfcJ  +  &  IV  JTC  (4\q\ 

o  'pct1k"a  ’k““_.e  ^cJ^[  ^ct('k"4+'k"“e)  ,'fct'k"“'vfc  y' 

In  order  to  uncouple  the  revised  stiffness  matrix  between  the  boundary  and  the 
unconstrained  nodes,  we  set 

E=-'K"U'‘ 'K"fc=’G  (4.18) 

This  matrix  is  identical  to  the  static  condensation  matrix  in  Guyan  reduction  as  stated  in 
Eq.  4.4.  Here,  the  master  and  slave  nodes  are  replaced  by  the  boundary  and 
unconstrained  nodes.  Then,  Eq.  4.16  becomes  [3,  4] 

{?H;  yri 

Now  Eq.  4.17  is  written  as 

|~I  'GTI'Ki6  K*uT  I  0  I  ~'kg  o' 

0  'F T  K"6  ’K“  'G  ^  0  K.  ^ 4 20^ 


KSVk‘“E  +  Et(K“Vk""E)  (,Kfcu  +  ErK“u)Vc 
^7('k"A+'k"“E) 


[o 

Similarly,  for  the  mass  matrix  we  get 

I  'gtT'mw 

0 

where  MGc=  (M^'M^G) . 


G  VF, 


(4.19) 


(4.20) 


(4.21) 


4.2.4.  Constrained  Modes  and  Modal  Condensation 


In  Section  6  the  equations  of  motion  will  be  truncated  to  obtain  smaller  sets  of  equations. 
When  this  process  is  performed  in  modal  space,  the  mode  shapes  and  corresponding 
entities  are  split  into  the  kept  and  deleted  sets.  The  process  discussed  in  this  sub-section 
will  be  applicable  to  the  condensation  techniques  used  in  Section  6. 

Assume  that  the  equations  of  motion  for  a  structure,  Eq.  3.1,  are  transformed  to  modal 
space  using  the  constrained  transformations;  i.e.,  Eqs.  4.14  and  4.15.  Furthermore,  we 
split  the  modal  coordinates  into  the  kept  and  deleted  modes  to  get 


Mw  'M'X"  8*  K“  K6Xtf  5m  T 

vFe*T  M"*  Mkc  0  •  z*  •+  ^>f'Kub  Kkc  0  -  z*  •=vF<*Tfu  •  (4-22) 

yY Mub  0  Mdc  \[id\  k'K"  0  K?  J[zrf  J  ['F/V 

In  a  process  similar  to  that  of  the  static  condensation,  we  assume  that  the  inertia  associated 
with  the  deleted  modes  are  allocated  to  the  boundary  nodes;  and  furthermore,  there  are  no 
forces  associated  with  the  deleted  modes  [5].  With  this  assumption,  the  third  row  of  Eq. 
4.22  yields 


'¥?’Mab 

'f„*t'm“6 


Tf  K"A 


K 


f ; 


(4.22) 


where 


zd=Q  5' 


0  =-  KdA  'F  rfT  Kub 


(4.23) 

(4.24) 


Note  that  0  transforms  a  set  of  nodal  coordinates  to  modal  coordinates. 


5.  Equations  of  Motion  for  A  Rigid-Flexible  Multibody  System 

A  multibody  system  may  contain  both  flexible  and  rigid  bodies.  The  Newton-Euler 
equations  for  a  typical  free  rigid  body  are  written  as 
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where  Mf  -  mr I  is  the  mass  of  the  body,  Jr  is  the  rotational  inertia  matrix,  and  fr  is  the 
external  force  vector  acting  on  the  body.  The  term  nr  =  n  +  sPr  fr  -  d)r  Jf  tor  is  the  sum  of 
applied  moments,  n,  the  moment  of  the  force  fr,  and  the  gyroscopic  moment.  It  is 
assumed  that  the  origin  of  the  body-fixed  frame  is  at  the  mass  center.  The  Euler  equations 
are  normally  written  in  terms  of  the  body-fixed  components,  however,  in  order  to  be 
consistent  with  our  flexible  body  formulations,  we  have  expressed  the  equations  in  terms 
of  the  global  components. 


/  \  r 


- ►  y 


Figure  3.  A  simple  rigid-flexible  multibody  system. 

In  order  to  discuss  different  formulations  for  a  rigid-flexible  multibody  system 
w^out  any  loss  of  generality,  we  concentrate  on  a  simple  multibody  system  containing 
only  one  rigid  and  one  flexible  body.  We  further  assume  that  the  connection  between  the 
two  bodies,  as  shown  in  Fig.  3,  is  at  point  b  representing  one  spherical  joint, 
l  he  kinematic  constraint  equations  at  a  typical  spherical  joint  is 

rr  +  s*  -  dfc  =  0  (5  2) 

The  velocity  and  acceleration  constraints  are:  '  ’  ' 

s>r  -  dA  =  °  (5.3) 

tt  •  ^  „  *V-sr6d),-d* +©fc5rs*  =  0 

Using  Eq.  3.7,  Eq.  5.4  can  also  be  expressed  as 

where  f,-s,*a)r-r  +  b‘d>-S‘  =  y*  (5.5) 

yb  =  —  cor  co  sfc  +  w6 

constlained  node3'  SPheriCa'  j°in,S  be,ween  ,her  b,<>dies'  E<!-  5  4  or  5-5  is  repeated  for  every 


5.1.  ABSOLUTE  NODAL  MOTION 

With  the  aid  of  Lagrange  multiplier  technique  [6],  we  append  Eqs.  5.1,  3.4  and  5.4  to 
form  the  equations  of  motion  for  the  multibody  system  as  * 
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5.2.  NODAL  DEFLECTIONS 

We  now  transform  Eq.  5.7  to  a  different  form  where,  instead  of  the  absolute  accelerations, 
accelerations  associated  with  nodal  deformation  are  used.  For  this  purpose  we  use  Eqs. 
3.22.b,  5.1  and  5.5  to  get 
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where  f0  =  iT(f-Mw),  n0  =  -bT (f -  Mw) ,  and  f/  =  f7  -M7’w-K 7'S;;  =  b,  u. 
5.3.  FREE-FREE  MODES 


We  can  transform  Eq.  5.8  to  modal  coordinates  using  the  free-free  modal  data.  Using  Eqs. 
4.11-4.13,  we  get 

r—  _  _  .  _  "1  (-  -»  f 
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where  ff  =  ( f-  M  w)  -  Kf? . 
5.4.  CONSTRAINED  MODES 


Equation  5.8  can  also  be  transformed  to  modal  coordinates  using  the  constrained  modal 
data  from  Eqs.  4.14  and  4.15: 
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(5.10) 


j  <-  J  ’  j 

\  fc  = T/  ( f  M  w-  K ui  56)-  Kcz . 
5.5.  CONSTRAINED  MODES  AND  STATIC  CONDENSATION 
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:  //  11  u,t-  ^uuiuiuaics  anu  aenecuons,  velocities,  and  external  and 

structural  forces  are  known,  Eqs,  5.7,  5.8,  5.9,  5.10,  or  5.1 1  could  be  solved  to  determine 
the  accelerations  and  Lagrange  multipliers. 

6.  Model  Reduction 

So  far  we  have  derived  the  equations  of  motion  for  a  multibody  system  in  a  variety  of 
lorms.  For  reducing  these  equations  into  smaller  sets  with  fewer  degrees-of-freedom  we 
need  to  eliminate  some  of  the  equations  associated  with  the  deformable  body.  In  order  to 
reduce  the  amount  of  error  associated  with  any  elimination,  we  must  minimize  the  amount 
o  coupling  between  the  kept  and  eliminated  equations.  An  inspection  of  the  equations  of 
motion  reveals  the  following:  If  the  mass  matrix  of  the  deformable  body  is  diagonal  many 
m.the  e^uatlons  of  motion,  including  the  coupling  terms  in  the  mass  matrix, 
vanish.  Even  if  the  mass  matrix  is  not  diagonal  but  the  elements  around  the  boundary 

nodes  are  small,  then  the  coupling  terms  Mbu  and  Mub  could  be  neglected.  This  process 
uncouples  the  two  sets  of  equations  in  the  mass  matrix. 

6.1.  NODAL  COORDINATES 

In  order  to  reduce  the  number  of  equations  in  the  nodal  coordinate  space,  the  static 
“3tl0n  prof ss  °PSecl10n  4-l  can  be  applied  to  Eq.  5.8.  With  this  process,  some  or 
all  of  the  unconstrained  nodes  are  removed,  and  a  set  of  condensed  mass  and  stiffness 
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matrices  are  obtained.  It  should  be  noted  that  with  these  condensed  matrices,  some  of  the 
simplifications  in  the  equations  of  motion  may  no  longer  be  valid.  For  example,  we  may 
need  to  use  Eq.  3.20. a  instead  of  3.20.b. 

6.2.  MODAL  COORDINATES 

The  modal  equations  of  motion  for  a  single  deformable  body  can  be  truncated  to  a  smaller 
set  since  the  modal  matrices  are  uncoupled  between  the  kept  and  deleted  modes.  However, 
when  the  deformable  body  is  part  of  a  multibody  system,  the  reduction  process  is  not  as 
straight  forward.  As  it  will  be  seen  in  the  following  sub-sections,  the  modal  matrices  are 
split  into  a  kept  set  (superscript  k)  and  a  deleted  set  (superscript  d).  The  idea  is  to  eliminate 

the  modal  accelerations  zd  and  its  corresponding  equations  from  the  equations  of  motion. 
Due  to  the  size  of  the  following  equations  of  motion,  only  those  portions  associated  with 
the  modal  coordinates  that  are  important  in  this  process  are  shown. 

6.2.1.  Free-Free  Modes 


Equation  5.9  is  split  into  the  kept  and  deleted  parts  as 
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(6.1) 


where  fj=x¥j  (f-Mw)-Ijz;/=  k,  d.  If  we  eliminate  id  and  the  corresponding 
equation,  we  observe  that  the  term  -VF  df'z  in  the  acceleration  constraints  is  also  eliminated. 
This  elimination  causes  the  constraints  to  be  violated  and  to  cause  erroneous  results. 


6.2.2.  Constrained  Modes 

Equation  5.10  is  re-written  in  the  following  form  for  the  reduction  process: 
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(6.2) 


where  ff=  'F/  (f"-M“’  w-K“6  8*)- KJcz\  j  =  k,  d.  If  we  eliminate  'z  and  the 
corresponding  equation,  we  observe  that  unlike  Eq.  6.1,  we  do  not  eliminate  anything  from 
the  constraint  equation.  Therefore  there  will  be  no  violation  in  the  constraints  due  to  this 

process.  However,  the  term  gets  eliminated  from  the  equation  associated  with  the 

boundary  node.  This  process  can  produce  enough  error  to  make  the  results  unacceptable. 

6.2.3.  Constrained  Modes  and  Static  Condensation 

For  the  reduction  process,  Eq.  5.1 1  is  re-written  as 
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where  M'c=,HVT('M"Vm“"'G)  and  yv)-KJcx;  j  =  k,  d.  Eliminating 

z  from  this  equation  does  not  effect  the  constraint  equation.  However,  we  do  eliminate 

the  term  z  from  the  equation  associated  with  the  boundary  node.  The  amount  of 
error  associated  with  this  elimination  is  much  smaller  (almost  negligible)  compared  to  the 

elimination  of  Mj  'z  from  Eq.  6.2.  This  difference  is  due  to  the  fact  that  in  Eq.  6.2,  6“  is 


purely  dependent  on  the  modal  coordinates.  However,  in  Eq.  6.3,  5U  is  a  function  of  both 

6  and  the  modal  coordinates  (refer  to  Eq  4.19).  Therefore,  the  truncation  some  of  the 
modes  from  Eq.  6.3  is  not  as  severe  as  it  is  in  Eq.  6.2. 


6.2.4.  Constrained  Modes  and  Modal  Condensation 


The  transformation  matrix  of  Eq.  4.23  can  be  substituted  into  Eq.  6.2  in  order  to  express 
the  deleted  modes  in  terms  of  the  boundary  nodal  deflections.  Then  the  equations  of 

motion  associated  with  the  boundary  nodes  are  prc-multiplicd  by  0T,  and  the  equations 
associated  with  the  deleted  modes  are  removed  to  obtain 


where  M  h0tM,,  M4  s0t(m“  +MjT0),  and  M^M^.  Simulation  with  Eq. 
6-4  provides  the  same  results  as  those  obtained  from  the  truncated  Eq.  6.3.  The  process 
that  led  us  to  Eq.  6.4  has  restored  some  of  the  information  associated  with  the  deleted 
modes  into  the  equations  of  motion.  This  is  analogous  to  the  restoration  of  information  in 
Eq.  6.3  through  the  Guyan  matrix.  The  main  difference  is  that  in  Eq.  6.4  the  information 
is  restored  in  the  modal  space,  whereas  in  Eq.  6.3  it  is  done  in  the  nodal  space. 

7.  Summary 

The  equations  of  motion  for  a  simple  rigid-flexible  multibody  system  have  been  presented 
in  this  manuscript  in  a  semi-abstract  form.  Nodal  rotational  degrees-of-freedom  have  been 
excluded  in  order  to  simplify  the  appearance  of  the  equations.  Mean-axis  conditions  have 
been  used  to  attach  a  reference  frame  to  the  deformable  body.  Several  model  reduction 
techniques  in  nodal  and  modal  spaces  have  been  reviewed. 

J{!e„m0(*e'  reduction  in  nodal  space  is  very  simple  to  implement.  However,  the  mass 
and  stillness  matrices  that  are  obtained  from  a  static  condensation  may  cause  numerical 
instability.  It  is  recommended  that,  if  possible,  smaller  matrices  to  be  obtained  directly 
j°Vrsej  ,te  ejement  mesh  rather  than  through  a  static  condensation  process. 

Model  reduction  in  modal  space,  either  from  a  free-free  or  a  constrained  structure 
without  any  compensation  terms  (such  as  in  Eqs.  6.1  or  6.2)  is  not  recommended.  These 
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processes  yield  either  severe  constraint  violation  with  inaccurate  results,  or  no  violation  and 
still  unacceptable  results.  In  contrast,  when  compensation  terms  are  incorporated  in  the 
condensation  process  (such  as  in  Eqs.  6.3  and  6.4),  not  only  there  will  be  no  constraint 
violation,  also  reasonably  accurate  results  should  be  expected.  The  accuracy  of  the  results, 
however,  is  proportional  to  the  degree  of  mode  truncation.  Several  variations  of  these 
compensation  terms  can  be  found  in  published  literature. 
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NUMERICAL  SIMULATION  OF  FLEXIBLE  MULTIBODY  SYSTEMS 
BY  USING  A  VIRTUAL  RIGID  BODY  MODEL 
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Universite  d’Evry  Val  d’Essonne,  91020,  EVRY, FRANCE 


1. Introduction 

In  the  past  decade,  interest  in  multibody  system  dynamics  has  grown,  leading  to  several 
computer  codes  [1]  available  for  the  generation  of  the  motion  equations.  If  in  the  beginning, 
only  multibody  systems  with  rigid  components  [2]  were  considered,  weight  minimization  and 
large  accelerations  in  many  technical  problems  lead  to  an  increasing  tendancy  for  elastic 
vibrations.  In  recent  years,  many  works  [3]  deal  with  the  dynamical  simulation  of  these 
systems  in  which  each  flexible  component  undergoes  large  rigid  body  motion  but  small  elastic 
deformations.  It  results  that  the  motion  equations  of  the  whole  system  involve  ordinary 
differential  equations  coupled  with  partial  differential  equations.  Approximated  methods  are 
used  in  which  the  displacement  field  of  each  flexible  component  is  discretized  by  a  Rayleigh- 
Ritz  method  leading  to  a  new  system  with  a  finite  number  of  degrees  of  freedom. 

The  aims  of  this  work  is  to  show  that  it  is  possible  to  use  any  existing  rigid  body  codes  for  the 
dynamical  simulation  of  elastic  multibody  systems  provided  that  these  codes  are  based  on 
variational  methods  like  Lagrange’s  equations  or  direct  applications  of  d’Alembert  principle. 
A  first  attempt  for  this  possibility  was  made  in  [4]  for  planar  interconnected  flexible  beams.  In 
the  present  work,  three  dimensional  interconnected  flexible  bodies  are  considered  and  the 
method  used  to  identify  the  approximated  model  of  the  flexible  multibody  system  with  a 
fictitious  rigid  multibody  system  is  rather  different  from  the  idea  used  in  [4],  An  example  is 
shown,  using  the  symbolic  dynamical  code  AUTOLEV  [5]  devoted  to  rigid  body  simulation. 


2.  Problem  Formulation 

Let  us  consider  a  multibody  system  composed  of  several  rigid  or  flexible  bodies  connected  by 
p  hinges.  Each  flexible  component  undergoes  large  rigid  body  motion  coupled  with  small 
structural  deformations. 
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Let  us  consider  one  flexible  component  (S)  of  the  system  and  its  fixed  reference  configuration 
(iS0)at  t  =  O.The  assumption  of  large  displacement  and  small  strains  lead  to  the  standard 

method  in  which  an  intermediate  configuration  (s )  of  the  body  is  introduced  :  (*S )  is 
deduced  from  the  reference  configuration  (S0  )  by  means  of  a  rigid  transformation.  For  each 

- > 

material  point  M,  we  define  the  displacement  field  u-M'M  where  M’  is  rigidly  connected 
to  The  position  of  M  with  respect  to  an  inertial  reference  frame  (O0 ,  X0 ,  yQ ,  zQ  )  is 
given  by : 

- >  - > 

r=c+x+u  c(t)  =  O0O;  x  =  OMr;  u  =  u(x,t ) 

O  is  the  origin  of  a  « floating  reference  frame  »  [6]  (0;x,y,z)  rigidly  connected  to  (S),co 

is  the  angular  velocity  vector  of  the  floating  reference  frame. 

The  kinetic  energy  of  the  flexible  body  (S)  can  be  written  as  : 


T  =  1/2  m c2  +  do.  J0  co  +  Jw2  dm  +  2c.ju  dm 

s  s 


+  2  a>.^(x  +  u)au  dm+ 2  c. a>  a  J(x  +  fr)dm 


where  J0  =  j[(x  +  uf  E  -  (x  +  u)®  (x  +  u))flm  is  the  inertia  tensor  in  point  0  of  the 
s 

body  (S)  in  its  deformed  configuration.  The  displacement  field  u  is  approximated  by  a  finite 
number  of  mode  shapes  : 

u  =  N(x)q(  t) 

<  r  ~  _  !  (2) 

^  =  [iVlv..57V„J^  =  l[qu.:,qn] 

It  results  for  the  kinetic  energy  the  following  approximated  expression  : 

T  =  -\mc2  +  co.J a  cb+  ‘ qMq  +  2c.a  q 

2  ?  (3) 

+  2  co.  G  q  +  2  c.{cb  a  m  x0 )+  2  c.  co  a  a  q  +  2  co.  (h_  q)qj 
with  the  following  notations  : 


175 


Let  us  assume  that  the  body  is  subjected  to  body  forces  f  and  surface  forces  F  applied  on  the 
boundary  dS  of  the  body.  For  a  virtual  velocity  field  defined  by 

V\M)  =  c'  +cb'  A(i+«)+!7* 

we  obtain  the  corresponding  virtual  power  of  the  applied  forces  : 

3,*  =  \fP\M)dv+  \Fp\M)da 

s  cS 

Using  the  approximated  value  (2)  of  the  displacement  field,  the  following  expression  of 
is  obtained  : 

3,  =  R.c*  +(m0  +Bq}a>*  +Dq*  (5) 
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where 


R  =  jf  dv+  Jf  da 


M0  =  j*3c  a  f  dv  +  Jx  a  F  da 


< 

D  =  jf.Ndv+  jP.Ndcy  ;  B  =  \NAfdv+  JAaF  da 

S  SS  S  dS 

Assuming  linear  constitutive  laws,  the  elastic  potential  energy  is  approximated  by 
Ve  =  1/2  ‘  q  Kq  ,  where  K  =  [Ky  )  is  the  n  x  n  constant  stiffness  matrix. 

3.  Rigid  body  model 

The  rigid  body  model  (ZR)  is  composed  of  a  rigid  body  (S R  )  rigidly  connected  to  the 
floating  reference  frame  (0;x,y,z)  and  a  total  number  of  3n  materials  points  M,  of  mass  mj 

defined  by  OMt  =  Xi  +  A,,  q  (i  =  l,2,...,3n).  In  this  formula,  X;  is  a  vector  fixed  with 
respect  to  the  floating  reference  frame  while  A;  is  a  1  x  n  matrix  of  whose  the  columns  are 
vectors  fixed  with  respect  to  the  same  reference  frame.  The  absolute  velocity  of  the  material 
_>  .  - > 

point  Mj  is  given  by  V(M  ■ )  =  C  +  d)  A  OM ( +  At  q 

It  results  for  the  system  (ZR)  the  following  expression  of  the  kinetic  energy 
3«  \  f «.  3« 

2T  =  m0  +  J]mi  c2  +  cb.  K0  +  J;  cb  +  2c{cb  a  x0)  + 


(?) 

2=1 

+  2 c.cb  a  +  A,.  qj+  2c. q  +  2  +  A,-  qj^Ai  #] 

2=1  2=1  2=1 
v. 

where  m0  and  K0  are  the  mass  and  the  inertia  tensor  in  point  O  of  the  rigid  body  (SR)  and 
m0  yQ  =  jx  dm  defines  the  position  of  the  center  of  mass  of  (  SR)  with  respect  to  point  O. 


At  last 


J,  =  mi  [(i-,.  +  A,.qf  E  -  (l,  +  A,qf  ®  [xi  +  A^j J  (i  =  1,2,...3«) 


By  identification  of  the  kinetic  energy  of  (SR)  with  the  expression  (3)  of  the  kinetic  energy 
of  the  flexible  component  (S) ,  we  obtain  the  following  equations  : 
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.  _  3  n  ^ 

J  Ndm  =  Y,  mi  di 

(9) 

S  i= 1 

f  -  3n 

JA(®  xdm  =  ^  mi  At 

(10) 

S  i=l 

.t  _  _  3 n 

J  dm  =  mi  Al  ®  A, 

(11) 

In  order  to  make  the  identification  for  the  applied  and  elastic  forces  of  the  real  system,  let  us 
assume  that  for  the  rigid  body  model,  the  applied  forces  on  the  part  (SR)  is  composed  of  a 

resultant  force  $  and  a  resultant  torque  f0  applied  in  point  O  while  each  point  Mj  is 
submitted  the  force: 

Fj  =  /i(.  X  i  —  Aj  q ,  (/tj Xn )  are  constants 
The  virtual  power  of  the  applied  forces  for  the  rigid  body  model  (S^ )  is  given  by 
*  3n  ^  f  3n  — >  ^ 

32=c.^  +  £F(.  +v.  f0  +  £  OM/  a^.  + 


t  (*.  X,  -  A  <?U q 

i=l 

By  identification  with  the  virtual  power  of  the  applied  and  elastic  forces  of  the  real  system  : 

*  t  TS-  •  * 

■^2  —  "*^1  “  Q  K  q 
we  obtain  the  following  relations  : 

^  =<3+£('i, -f, -2,  ?)  (i 

M0+l9  =  f0+]r  om*  A Fi=f0 +!;(£,.?  a(A,+1)X,)  (1 


d=Y^\x,.a, 

i=l 

3n  t  _ 

K  =  Z  A,.  A, 


178 


The  two  first  equations  (12)  and  (13)  define  the  resultant  force  (f)  and  the  resultant  torque  ro 
applied  on  (SR  )  when  ,  Xt ,  At  are  known. 

We  conclude  that  to  obtain  a  rigid  body  model  of  the  flexible  component  we  have  to  solve 
with  respect  to  the  unknown  quantities  (mi,Ai,Xi,Aij  the  equations  (9),  (10),  (11),  (14) 
and  (15). 

The  total  number  of  unknown  variables  is 

X  =  3  n  +  9  n2  +9n  +  3n  =  9  n2  +15  n. 

The  total  number  of  equations  to  be  fullfilled  is  : 

_  _  .  _  (3«  +  l)  (/2  + 1)  _  2  1  ^ 

E  =  3n  +  9n  +  3n  - - -  +  n  +  n  - - -  =  5n 1  + 1 5n 

2  2 

It  results  that  the  number  of  unknown  variables  being  greater  than  the  number  of  equations, 
founding  a  rigid  body  model  is  always  possible  and  there  are  several  solutions. 

4.  Conclusions 

In  this  paper,  we  have  shown  that  it  is  possible  to  use  any  dynamical  codes  devoted  to  rigid 
multibody  systems  in  which  the  motion  equations  are  obtained  from  d’Alembert  principle  for 
the  simulation  of  flexible  multibody  systems  in  which  the  flexible  components  are  discretized 
by  a  Rayleigh-Ritz  procedure.  Three  dimensional  elastic  components  are  considered  and  not 
only  elastic  beams  as  in  [4].  The  method  is  based  on  the  identification  of  the  kinetic  energy, 
potential  energy  and  virtual  work  of  the  applied  forces  for  the  real  system  and  a  fictitious  rigid 
multibody  system.  The  main  interest  of  this  result  is  the  possibility  of  using  symbolic 
dynamical  codes  mainly  available  for  rigid  multibody  systems  for  the  dynamical  simulation  of 
flexible  multibody  systems  Several  simulations  tests  are  done  using  the  symbolic  code 
AUTOLEV  showing  the  efficiency  of  the  method. 
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1  Introduction 

A  novel  methodology  for  the  analysis  of  roller  chain  drives  is  developed  and 
implemented  in  a  computer  code  in  order  to  study  the  dynamics  of  a  roller-chain  drive, 
which  includes  the  chain  flexibility,  its  transversal  and  longitudinal  vibrations  and 
meshing  contact/impact  models.  The  main  components  of  the  roller  chain  drives 
include  fixed  or  moving  sprockets  and  the  chain  made  of  rollers  and  links,  which  are 
modeled  as  rigid  bodies,  mass  particles  and  springs-damper  assemblies  respectively. 
The  models  proposed  represent  effectively  the  polygonal  effect,  always  present  in  this 
type  of  drives,  and  therefore,  all  vibrational  dynamics  associated  to  it. 

Two  contact/impact  methods  arc  proposed  to  describe  the  contact  between  the 
rollers  of  the  chain  and  the  teeth  of  the  sprockets.  These  formulations  are  based  on  the 
use  of  unilateral  constraints  and  a  continuous  force  method,  respectively.  In  the 
unilateral  constraint  method  the  kinematic  constraints  are  introduced  in  the  system 
anytime  a  contact  between  the  rollers  and  the  sprockets  is  detected.  The  condition  for 
the  constraint  addition  is  based  on  the  relative  distance  between  the  roller  center  and  the 
sprocket  center,  i.e.  a  constraint  is  added  when  such  distance  is  less  than  the  pitch 
radius.  The  unilateral  kinematic  constraint  is  removed  when  the  constraint  reaction  force 
associated  with  it  is  pulling  it  away  from  the  sprocket.  In  order  to  improve  the 
numerical  efficiency  of  the  methodology  only  the  first  and  last  roller  seated  on  each 
sprocket  and  the  two  free  rollers  nearest  to  the  sprocket  are  checked  for  capture  or 
release. 

In  the  continuous  force  method  the  contact  is  represented  by  forces  applied  on  each 
seated  roller  and  in  the  respective  sprocket  teeth,  which  are  functions  of  the  pseudo 
penetrations  between  roller  and  sprocket,  impacting  velocities  and  a  restitution 
coefficient.  In  this  method  the  geometry  of  the  tooth  profile  is  represented  in  order  to 
allow  for  a  correct  representation  of  the  tangential  forces. 
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The  two  methods  are  demonstrated  through  examples  of  application  to  roller-chain 
drives  that  include  sprockets  with  different  sizes.  Finally  the  proposed  methodology  is 
applied  to  the  simulation  and  analysis  of  the  roller-chain  drive  of  a  large  marine  diesel 
engine.  Moreover,  the  application  model  includes  a  chain  tightener  and  off-center 
sprockets,  used  in  second-order  compensators  to  cancel  the  vibrations  induced  by  the 
main  engine. 

2  Roller-Chain  Models  With  Unilateral  Constraints 

A  typical  roller-chain  drive  in  a  marine  diesel  engine  is  composed  of  one  chain  that 
wraps  around  two  or  more  sprockets.  The  roller-chain  is  somewhat  similar  to  a  bicycle 
chain  in  the  way  it  looks.  For  the  purpose  of  the  study  presented  here,  the  mass  of  the 
chain,  is  assumed  to  be  lumped  at  the  roller  locations.  Translational  springs  and 
dampers  with  constant  stiffness  and  damping  coefficients  model  the  links.  In  this  model 
the  rotational  inertia  of  the  rollers  about  their  center  of  gravity  is  neglected. 

The  tooth  flexibility  of  the  sprocket  is  neglected  in  this  model,  i.e.  the  sprocket  is 
considered  to  be  a  rigid  body.  The  roller-chain  wraps  around  the  sprocket  forcing  the 
rollers  to  seat  between  the  teeth  at  a  distance  from  the  center  of  the  sprocket  equal  to  the 
radius  of  the  pitch  circle.  In  this  study  it  is  assumed  that  during  engagement  the  chain 
pitch  equals  the  sprocket  pitch.  Effects  like  chain  wear  and  the  pitch  elongation  during 
engagement  are  neglected. 


Bedded  rollers 


Figure  1.  Numerical  representation  of  the  roller  engagement  with  the  sprocket 

2.1.  EQUATIONS  OF  MOTION  FOR  THE  ROLLER-CHAIN  DRIVE 

The  rollers  that  are  not  seated  in  the  sprockets  constitute  a  particle  system  free  in  space. 
Their  equations  of  motion  are 

iq,=f,  (1) 

where  I  is  the  unit  matrix,  mr  is  the  mass  of  the  links  and  qr  is  the  translational 
accelerations  of  the  rollers.  The  right  hand  side  f  is  the  vector  with  the  forces  acting  on 
the  individual  chain  links  due  to  the  links  flexibility. 

For  a  sprocket  having  an  external  applied  force  f,  the  equations  of  motions  are 
given  in  equation  (2).  The  external  forces  are  made  up  from  the  forces  with  which  the 
chain  affect  the  sprocket  and  from  optional  directly  applied  forces. 

^5  ^5  (2) 
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where  the  matrix  contains  the  mass  and  polar  moment  of  inertia  of  the  sprocket,  the 
vector  contains  the  acceleration  of  the  sprocket  in  the  x-  and  ^-direction  and  the 
angular  acceleration,  thus  rotational  inertia  for  the  sprocket  is  taken  into  account. 

In  the  constraint  method  the  rollers  that  are  seated  on  the  sprockets  are  treated  as 
constrained  bodies.  For  the  bedded  rollers  on  a  sprocket,  constraint  equations  that  force 
the  rollers  to  be  seated  on  the  pitch  circle  at  the  bottom  of  the  tooth  profile  are  defined. 
Differentiating  these  equations  twice  with  respect  to  time,  and  using  the  Lagrange 
multiplier  technique  [3],  leads  to  a  set  of  equations  of  motion  for  sprocket  number  s  and 
for  the  rollers  in  contact  with  it  is  written  as 


M 

s 

0 

0 

mr1 

S7" 

I 

V 

k _ _ < 

f  * 

8, 

f 

r 

> 

(3) 

S 

I 

0 

_  X  t 

?s. 

where  X  is  the  vector  Lagrange  multipliers,  ys  is  the  right  hand  side  from  the  acceleration 
of  the  constraint  equations  and  the  matrix  [S  I]  is  the  Jacobian  matrix.  One  of  the 
attractive  features  of  this  formulation  is  that  the  forces  developed  during  the 
engagement  process  of  the  rollers  in  the  sprockets  are  always  available. 

A  roller  is  captured  onto  a  sprocket  if  the  distance  between  the  center  of  the  roller 
and  the  center  of  the  sprocket  is  less  than  the  radius  of  the  pitch  circle.  A  roller  can 
leave  a  sprocket  and  become  part  of  the  “free”  chain  segment  again  if  the  reaction  force 
between  the  sprocket  and  the  roller  changes  from  a  pushing  force  to  a  pulling  force.  For 
further  details  see  [1], 


Figure  2.  The  indentation  contact  between  a  roller  and  a  sprocket 

2  Force  Model  of  The  Roller-Sprocket  Engagement 

An  alternative  procedure  to  describe  the  capture  of  the  roller  by  a  sprocket  is  to  use  a 
non-linear  force  contact  model  that  takes  into  account  the  impact  that  occurs  during 
engagement.  Based  on  the  Hertzian  contact  theory  several  models  have  been  proposed 
which  take  into  account  the  energy  dissipation  due  to  heat,  noise,  vibrations  or  localized 
deformations.  Lankarani  and  Nikravesh  [2]  proposed  an  impact-contact  model  that 
besides  providing  an  accurate  description  of  the  physical  phenomena  is  numerically 
stable,  leading  to  an  efficient  computer  implementation.  The  contact  model  proposed 
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here  to  describe  the  roller-sprocket  engagement  is  based  on  the  model  by  Lankarani  and 
Nikravesh  and  it  takes  into  account  the  specificity  of  the  roller-chain  dynamics. 

2.1.  THE  CONTACT-IMPACT  FORCE  MODEL 

For  a  roller-chain  drive,  with  equal  chain  and  sprocket  pitch,  the  capture  of  a  roller  by 
the  sprocket  is  instantaneous,  i.e.,  the  roller  will  seat  at  the  low  part  of  the  tooth  profile, 
without  rolling  into  it  from  some  neighboring  position.  This  is  seldom  the  case  in  a 
normal  chain-roller  drive  due  to  the  wear  of  the  chain  or  because  the  links  are  not  rigid 
and  elongate  as  a  result  of  the  dynamic  loading.  In  the  numerical  model  now  presented 
for  the  contact  a  pseudo-penetration  of  a  roller  in  a  tooth  profile  is  determined  and  in 
turn  gives  raise  to  contact  forces  that  tend  to  balance  the  remaining  forces  over  the 
bedded  roller. 

All  the  rollers  are  ’free’  in  this  model  and  the  contact  forces  are  added  to  the  right 
hand  side  of  equations  (1)  and  (2).  Let  the  contact  force  between  the  roller  /  and  the 
sprocket  s  be  a  function  of  the  pseudo  penetration  and  pseudo  velocity  of  penetration 
given  by  [2] 

f„,  =  (KS;  +  DSr)  u r  +  (KS:  +  DS,)  u, , with  (4) 

where  D  is  a  damping  coefficient  and  K  is  a  generalized  stiffness  coefficient  that 
depends  on  the  geometry  of  the  surfaces  in  contact  and  their  material  properties  and  the 
exponent  n  is  set  to  1.5  for  metallic  surfaces,  see  figure  (2).  The  components  of  the 
pseudo  penetration  5  in  the  radial  and  tangential  direction  are  respectively  5,.  =u^5and 

5/=u[5,  where  ur  and  u,  are  unit  vectors  in  the  radial  and  tangential  directions 
respectively  that  pass  by  the  theoretical  position  of  the  roller  center  in  its  bedded 
position.  The  pseudo  penetration  velocity  components  are  8r  and  S, .  The  damping 

coefficient  D  introduces  the  hysteresis  form  of  the  energy  dissipation,  which  depends  on 
the  restitution  coefficient  (e=l  for  a  fully  elastic  contact  and  e=0  for  a  fully  plastic 
contact),  on  the  relative  approach  velocity  between  the  roller  and  sprocket,  on  the 
generalized  stiffness  coefficient  and  on  the  exponent  n. 

If  the  position  of  the  actual  roller  center  is  between  the  pitch  and  the  outer  diameter 
of  the  sprocket  there  is  a  potential  for  pseudo-penetration  in  the  tooth.  The  contact  with 
the  tooth  profile  is  modeled  as  in  equation  (4)  and  it  is  assumed  sufficient  to  consider 
the  profile  of  the  tooth  to  be  approximately  linear.  For  further  details  see  [1]. 

3  Model  of  Chain  tighteners  in  the  force  model 

While  the  engine  is  running  the  roller  chain  wears  and  consequently  extends.  Therefore, 
the  chain  has  to  be  tightened  frequently  as  it  gradually  extends,  in  order  to  keep  its 
functionality.  To  this  purpose  one  of  the  driven  sprockets  is  located  in  a  chain  tightener 
system.  This  sprocket  center  can  move  from  its  initial  position  and  then  tighten  the 
chain.  To  avoid  the  manual  tightenings  of  the  chain  automatic  chain  tighteners  have 
been  introduced  on  some  engines.  This  has  caused  undesirable  vibration  patterns  of  the 
chain  and  chain  tightener  that  were  not  immediately  explainable. 
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The  sprocket  that  is  in  the  chain  tightener  translates  and  its  movement  depends  on 
the  movement  of  the  other  elements  in  the  chain  tightener  system.  The  chain  tightener 
system  has  been  included  in  the  force  model.  This  is  done  by  introducing  kinematic 
constraints  between  the  sprocket  and  the  other  bodies  (e.g.  weight-arm)  in  the  tightener 

system  and  for  the  chain  tightener  with  a  hydraulic  damper  this  is  modeled  as  a  spring- 
damper.  r  b 

The  constraint  equations  are  set  up  for  the  chain  tightener  system  including  revolute 
joint  constraint  and  translational  joint  constraints  [3],  These  constraint  equations  are 
differentiated  twice  with  respect  to  time,  and  using  the  Lagrange  multiplier  technique  as 

in  equation  (3)  the  total  set  of  equations  for  the  sprocket  in  the  chain  tightener  system  is 
written  as 
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where  MB  is  the  mass  and  inertia  of  the  other  bodies  in  the  chain  tightener  system,  qB  is 

the  accelerations  of  the  bodies,  fB  is  the  forces  on  the  bodies,  y,  is  the  right  hand  side 
from  the  acceleration  of  the  constraint  equations  and  [Js  Ja]  is  the  Jacobian  matrix. 

4  Application  to  A  Roller-Chain  Drive 

The  total  methodology  is  applied  to  the  simulation  of  a  two-stroke  diesel  marine 
engine  roller-chain  drive.  The  drive  is  standard  in  the  engines  that  have  between  4  and 
12  cylinders  for  a  power  range  of  1760  to  7800  KW.  The  roller-chain  drive,  composed 
o  four  sprockets  and  a  chain  made  of  122  links,  transmits  the  motion  of  the  crankshaft 
to  the  camshaft.  Each  link  of  the  chain,  with  a  pitch  of  0.0889  m  and  a  mass  of  3.01  Kg 
is  modeled  as  a  flexible  element  with  a  stiffness  of  640  MN/m,  according  to  the 
experimental  data  obtained  from  the  manufacturer. 
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The  top  sprocket,  in  figure  3,  is  connected  to  a  weight-arm,  which  in  turn  is 
connected  with  a  hydraulic  damper.  These  elements  together  form  the  chain  tightener 
system.  The  sprocket  is  connected  to  the  weight-arm  with  a  revolute  joint  and  the 
weight-arm  is  connected  to  the  ground  through  a  revolute  joint  and  a  spring-damper. 

The  methodology  proposed  here  is  implemented  in  a  computer  code  and  applied  to 
the  roller-chain  drive  described.  The  model  is  simulated  during  a  time  period  of  25 
second  being  accelerated  from  rest  to  a  constant  angular  velocity  during  2  seconds.  The 
results  of  the  simulations  are  summarized  by  the  force  on  a  reference  link  shown  in 
figure  (3). 

5  Conclusions 

New  formulations  for  the  simulation  of  the  dynamics  of  roller-chain  drives  are 
described  in  this  work.  With  these  methods  it  is  possible  to  perform  a  dynamic 
simulation  of  the  roller-chain/sprocket  system,  including  the  polygonal  effect,  which 
appears  when  the  individual  chain  links  engages  and  disengages  the  sprockets,  the  roller 
impact  at  engagement,  the  flexibility  of  the  links  and  the  coupling  between  axial  and 
transverse  vibrations.  Moreover,  the  formulation  allows  for  the  introduction  off-center 
sprockets  in  the  roller-chain  drives,  which  are  sources  of  extra  excitations  on  the  drive. 

The  application  to  the  roller-chain  drive  to  a  large  marine  engine  demonstrates  the 
level  of  modeling  that  is  possible  to  achieve  with  the  purposed  formulation.  The 
variation  of  the  link  forces  exemplifies  the  type  of  results  necessary  for  the  design  of  the 
roller-chain  drives  in  terms  of  fatigue  and  wear. 

The  constraint  method  does,  however,  not  include  clearance  between  pin  and 
bushing,  the  rotational  inertia  of  the  link  elements,  tooth  flexibility,  and  the  actual  shape 
of  the  teeth.  The  continuous  force  method  allows  the  modeling  of  the  referred  effects  by 
tuning  up  the  coefficients  of  contact  law.  The  results  show  a  very  high  sensitivity  of  the 
results  on  the  chain  stiffness,  actually  suggesting  that  a  more  in-depth  investigation  of 
the  material  behavior  of  the  chain  and  sprocket  is  required.  Further  results  of  the 
application  of  both  methodologies  described  are  necessary  in  order  to  compare  their 
relative  merits  and  their  sensitivity  to  the  initial  data  set  of  the  roller-chain  drive. 
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Abstract 

The  optimal  design  of  vehicle  structures  is  usually  carried  out  using  finite  elements  programs. 
However,  the  design  tools  for  multibody  systems  can  be  an  alternative  to  the  finite  elements 
tools,  especially  in  the  first  stages  of  the  project  and  when  crashworthiness  and  dynamics 
requirements  are  to  be  included. 

In  this  paper  a  framework  for  the  dynamics,  sensitivity  analysis  and  optimization  of 
multibody  systems  are  presented. 

The  formulation  for  the  dynamic  analysis  is  based  in  a  moving  frame  approach  to  describe  the 
kinematics  of  the  deformable  bodies  where  the  large  rigid  motion  is  described  using  Cartesian 
coordinates  and  the  flexibility  is  introduced  using  the  finite  element  method. 

Analytic  sensitivities  obtained  by  the  direct  differentiation  method  and  finite  differences 
sensitivities  are  used  in  the  optimization  process.  The  optimization  process  includes 
constrained,  multicriteria  and  multiload  optimization  methodologies. 

The  framework  for  the  design  of  rigid-flexible  multibody  systems  is  applied  to  a  group  of 
applications,  including  the  design  of  train  structures  in  crashworthiness,  design  of  automotive 
chassis  using  dynamic  loads  and  other  mechanisms  related  with  vehicles. 

1.  Introduction 

The  design  of  vehicle  structures  is  usually  carried  out  using  finite  elements  programs.  In  order 
to  optimize  parameters  or  characteristics  of  the  vehicle  for  crashworthiness,  finite  elements 
programs,  such  as  LS-DYNA  or  PAM-CRASH,  leads  to  several  drawbacks:  the  time 
necessary  to  develop  the  models  is  large  and  in  general  these  programs  do  not  include 
optimization  procedures. 

In  the  first  stages  of  the  design  project,  when  the  detailed  characteristics  of  the  structure  are 
not  yet  known,  simplified  models  that  allows  simulation  and  optimization  can  be  used  with 
success.  Alternative  design  tools  based  on  multibody  dynamics  formulations  can  be  used. 
The  design  of  vehicle  structures  for  crashworthiness  and  the  elastic  design  of  vehicle  chassis 
under  dynamic  loads  are  two  of  these  scenarios. 

Different  design  tools  can  be  created  in  order  to  achieve  different  design  goals,  during  the 
product  development.  Train  crashworthiness  is  one  of  the  industrial  applications  where  this 
design  framework  can  be  applied.  Uni-dimensional  rigid  models  can  be  used  for  the  analysis 
of  the  energy  distribution  along  the  train  during  a  collision,  as  also  to  evaluate  overall 
deformations,  forces  and  accelerations.  The  ID  design  models  can  be  used  to  optimize  the 
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characteristics  of  the  energy  absorption  devices.  Two-dimensional  models  (rigid  or  flexible) 
can  be  used  to  analyze  the  structural  behavior  of  the  end-underframe  of  the  train  cars  or  the 
overlapping  phenomena  and  to  the  optimal  design  of  the  structural  elements.  Three- 
dimensional  models  can  be  used  for  detailed  analysis  and  design  of  the  structures  and  to  study 
the  entire  car  shells  as  also  to  design  the  structural  elements.  In  all  these  models  optimal 
design  plays  an  important  role,  so  the  sensitivity  analysis  and  the  optimization  of  multibody 
systems  are  important  topics  in  the  development  of  these  tools. 

Optimal  design  is  currently  a  topic  of  intensive  research  in  the  field  of  multibody  systems  [1]. 
During  the  last  two  decades  the  multibody  dynamics  formulations  have  been  developed,  being 
now  several  commercial  codes  for  the  analysis  of  such  systems.  However  there  is  still  a  lack 
in  the  development  of  optimal  design  tools  especially  for  flexible  systems. 

In  this  work,  formulations  and  methodologies  for  the  analysis  and  optimal  design  of  flexible 
multibody  systems  are  presented  within  the  framework  of  multibody  dynamics,  sensitivity 
analysis  and  optimization.  This  framework  is  presented  in  figure  1. 


Figure  1.  Framework for  the  optimal  design  of  rigid-flexible  multibody  systems 


Multibody  dynamics  formulations  are  developed  using  a  moving  frame  approach  to  describe 
the  kinematics  of  the  deformable  bodies.  The  large  rigid  motion  is  described  using  Cartesian 
coordinates  and  the  flexibility  is  introduced  using  the  finite  element  method.  To  reduce  the 
number  of  elastic  degrees  of  freedom,  the  component  mode  synthesis  is  used.  The  mean  axis 
condition  method  is  applied  to  the  reference  conditions  to  reduce  the  dynamic  coupling 
between  rigid  and  flexible  coordinates. 

For  the  optimization  procedure  the  multibody  dynamics  code  is  linked  with  general 
optimization  algorithms  included  in  the  package  DOT/DOC.  The  optimization  procedure 
requires  the  sensitivities  of  the  objective  function  and  design  constraints.  For  this  purpose, 
numerical  sensitivities  using  the  finite  difference  method  and  analytic  sensitivities  from  the 
direct  differentiation  method  are  used. 

The  framework  for  the  design  of  rigid-flexible  multibody  systems  is  applied  to  a  group  of 
applications,  including  the  design  of  train  structures  in  crashworthiness,  design  of  automotive 
chassis  using  dynamic  loads  and  other  mechanisms  related  with  vehicles. 
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2.  Dynamic  Analysis 


The  equations  of  motion  for  a  rigid-flexible  multibody  system,  written  in  terms  of  modal 
coordinates,  are  briefly  written  as  [2] 
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Where  Mrr  contains  the  rigid  body  inertia  M Iff  is  the  standard  finite  element  mass  matrix, 
is  the  inertia  coupling  between  rigid  and  flexible  coordinates,  X  is  the  Lagrange  multiplier 
vector,  fr  and  ff  are  the  generalized  external  forces,  gr  and  gf  are  the  quadratic  forces 

including  gyroscopic,  Coriolis  forces  and  other  terms  associated  with  kinetic  energy.  The 
coupling  between  elastic  deformation  and  rigid  body  motion  is  represented  by  the  term 
K^-q/  in  the  right-hand  side  of  equation.  Cff  is  the  damping  matrix  and  Ot,Ot  are  the 

Jacobian  terms  associated  to  the  rigid  and  flexible  coordinates  respectively.  Equation  (1)  with 
the  initial  conditions 

{q/'Vq?  ,P /OVpJ.q.l'Vq?,  P/('°)  =  P?}  (2) 

can  be  integrated  in  time  to  obtain  all  the  state  variables  of  the  system,  i.  e.  positions, 
velocities,  accelerations  and  Lagrange  multipliers. 

The  dynamic  analysis  tools  developed  include  several  features  necessary  to  solve  specific 
problems  specially  related  with  crashworthiness  such  as,  local  plastic  hinges  models,  dynamic 
stress  analysis  and  Hertz  contact-impact  models. 


3.  Sensitivity  Analysis 


The  analytic  sensitivity  equations,  obtained  using  the  direct  differentiation  method  are  here 
summarily  presented  in  the  modal  form.  The  sensitivity  equations  can  be  written  in  a  compact 
form  matrix  form  identical  to  the  equations  of  motion,  as  [2] 
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Equation  (3)  can  be  integrated  in  time  provided  the  initial  conditions 

Kbf'Vq",  P/b('")  =  P/l.\<,")  =  <.P/b('")  =  P/b}  (4) 

The  modal  sensitivities  are  then  transformed  to  nodal  or  physical  sensitivities.  Either  an 
updated-mode  approach,  where  a  Nelson’s  scheme  is  used  to  evaluate  the  derivatives  of  the 
vibration  modes,  or  a  fixed-modes  approach,  where  the  derivatives  of  vibration  modes  are 
neglected,  are  considered. 

Different  types  of  design  variables  related  to  flexible  elements  such  as  area  of  the  sections, 
Young  Modulus,  moment  of  inertia,  and  design  variables  involving  element  actuators  and 
kinematic  constraints  may  be  considered. 
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The  calculation  of  the  terms  in  the  right-hand  side  of  sensitivity  equations  (3)  represents 
the  major  computational  effort.  The  symbolic  computation  program  MAPLE  is  used  to  obtain 
these  terms  for  a  given  set  of  design  variables.  For  the  differentiation  of  the  finite  element 
matrices,  an  exact  method  is  used  once  the  analytical  expressions  for  the  mass,  stiffness  and 
other  matrices  involving  the  flexible  terms,  are  given  in  closed  form  for  specific  finite 
elements. 

As  in  the  case  of  rigid  body  sensitivities,  the  left-hand  side  of  the  dynamic  and  sensitivity 
equations  is  the  same.  Both  equations  are  integrated  simultaneously  in  time. 

4.  Examples 

In  this  section,  three  application  examples  of  the  framework  for  the  analysis  and  design  of 
rigid-flexible  multibody  systems  are  presented.  These  examples  correspond  to  the  application 
of  the  increasing  complexity  design  tools.  ID  tools  for  train  collisions,  2D  tools  for 
mechanisms  and  structures  with  planar  motion  such  as  end-underframes  of  trains  and  3D  tools 
for  vehicle  dynamics. 


4. 1 .  SIMULATION  OF  TRAIN  COLLISIONS  WITH  1 D  MODELS 

This  example  represents  the  kind  of  simulation  tasks  carried  out  in  the  European  Project 
Safetrain  [3],  where  collisions  between  train  sets  representative  of  the  European  railway  have 
been  simulated.  Figure  2  illustrates  a  front-front  collision  between  two  equal  trains  composed 
by  3  cars.  One  of  the  trains  travels  at  55  km/h  and  collides  with  the  other  train  stopped  and 
braked  on  the  line.  This  speed  covers  90%  of  all  the  real  train  collisions  in  this  collision 
scenario  (front-front).  In  figure  3  an  example  of  the  results  obtained  from  the  simulation  is 
presented.  The  simulation  results  include  displacements,  velocities,  sustained  accelerations, 
energy  distribution  along  the  train  and  dissipated  energy  on  each  energy  absorption  device. 
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Figure  2.  Characteristics  and  data  of  the  front-front  collision  between  two  3-car  trains 


From  the  analysis  of  figure  3,  it  can  be  observed  that  sustained  accelerations  levels  are 
below  5  G  that  is  the  value  usually  accepted  as  the  limit  allowed.  In  fact  the  accelerations  are 
one  of  the  most  important  parameters  to  be  considered  into  the  project,  because  they  are 
directly  related  with  vehicle  occupant  injuries. 


Figure  3.  Accelerations  and  energy  absorbed  for  the  front-front  collision  between  two  3-car 

trains 


4.2.  OPTIMIZATION  OF  THE  ENERGY  ABSORPTION  DEVICES 

The  characteristics  of  energy  absorption  devices  located  in  the  front  of  the  cars,  establishes 
the  overall  behavior  of  the  trains  and  consequently  the  occupants  safety.  The  characteristics 
of  these  devices  represented  in  the  models  by  force-displacement  curves,  as  shown  in  figure  2, 
can  be  optimized  in  order  to  increase  the  safety  of  the  vehicles. 

In  this  example,  a  5-car  train  is  considered.  Preliminary  studies  have  shown  that  the  safety 
increases  when  the  amount  of  energy  absorbed  in  the  front  of  the  trains  increases.  Another 
important  aspect  is  that,  to  increase  the  energy  absorption  between  cars,  more  space  is  needed 
for  deformation,  but  the  space  available  between  cars  is  limited  by  functional  reasons,  and 
less  space  required  for  deformation  allows  more  space  for  the  passenger  compartment.  That’s 
why  the  design  function  as  been  chosen  as  the  minimization  of  the  energy  absorbed  between 
cars  (LE-Low  energy  interfaces).  This  design  function  will  cause  an  energy  absorption 
transfer  from  the  LE  interfaces  to  the  HE  Interfaces,  so  a  design  constraint  should  be  specified 
for  the  energy  absorbed  in  fronts  (HE-High  Energy  Interfaces). 

The  design  variables  are  related  with  the  characteristics  of  the  energy  absorption  devices, 
more  specifically  with  the  force  levels  of  the  energy  absorption  devices. 

In  this  example  the  energy  absorption  devices  are  optimized  for  the  front-front  collision 
scenario  at  55  km/h.  The  optimization  problem  is  summarized  in  table  I. 

_ TABLE  I.  Optimization  problem  of  the  energy  absorption  devices  in  a  train 

Design  Function  min  ^LE; 

_ _ _ _i=l _ 

- acc,.  <5g  /=l,...,«cars 

Design  Constraints  -  LE,.  <  1  MJ  /  =  1,  ...,  «LE  ;  HE,  <  10  MJ  i  -  1,  ...,  nHE 

_ _ -  Def,  <  x,  i  =  l,  ...,  nu  +  ftHe ;  Lxe.  >  Lxe._x  +  500 KN 

Design  Variables  W] 

With:  «cars  Total  number  of  cars;  nlE  -  Number  of  Low-Energy  Interfaces  (LE); 

"he  -  Number  of  High-Energy  Interfaces  (HE);  LEj  -  Energy  Absorbed  in  Low  Energy 
interface  i;  acc,.  -  Maximal  acceleration  level  in  car  i;  Def;.  -  Maximal  allowed  deformation  in 

interface  i,  Llei,Lle1,Llej  -  Low-Energy  plastic  limits;  LHEX,LHE1,LHEi  -  High  energy  plastic 
limits. 
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The  optimization  problem  has  6  design  variables  and  36  design  constraints.  This 
constrained  minimization  problem  is  solved  using  a  quadratic  programming  algorithm.  The 
initial  and  optimal  plastic  levels  are  presented  in  table  II.  The  design  function  that  corresponds 
to  the  energy  absorbed  in  the  Low-Energy  interfaces  has  been  reduced;  from  8.88  MJ  to  7.03 
MJ  that  represents  a  decrease  of  22%. 

_ TABLE  II.  Optimization  results  of  the  energy  absorptidn.devices  in  a  train 


Low  Energy  Devices 

High  Energy  Devices 

Force  Level  ID 

Llei 

LlE2 

LlE3 

Hhei 

IT 

W-HE2 

HhE3 

Force 

Initial 

1000 

2000 

3500 

1000 

2000 

3000 

Optimal 

1022 

2245 

3234 

1343 

2126 

2929 

Displacement 

Both 

100 

800 

1000 

200 

200 

500 

Reductions  in  the  sustained  acceleration  peaks  are  obtained.  These  reductions  that 
correspond  to  an  increase  of  the  passive  safety  of  the  vehicle  are  due  to  higher  deformations 
in  the  front  of  the  trains.  In  fact,  due  to  the  design  function  selected,  an  energy  absorption 
transfer  from  the  interfaces  between  cars  to  the  front  of  the  train  has  occurred. 

From  the  optimal  specifications  for  the  energy  absorption  devices  obtained,  and  verified 
the  safety  of  the  train  in  others  collision  scenarios,  the  devices  can  be  then  designed,  using 
more  detailed  simulation  tools  such  as  finite  element  programs.  The  requirement  for  the 
detailed  models  is  that  the  crashworthiness  behavior  of  the  designed  structure  and  energy 
absorption  devices  must  averagely  satisfy  the  force  levels  specified. 

4.3.  MULTI-LOAD  DESIGN  FOR  CRASHWORTHINESS  OF  A  TRAIN  WAGON 

In  this  example  a  multi-load  optimization  procedure  is  applied  to  the  design  of  the  end- 
underffame  of  a  train.  The  objective  function  corresponds  to  the  minimization  of  the 
accelerations  levels  at  the  structure  for  a  typical  impact  velocity  (30  km/h)  against  a  rigid 
wall.  Service  loads  (5  km/h)  are  included  as  design  constraints.  The  optimization  problem  is 
indicated  in  table  III  and  in  the  optimization  results  in  table  IV. 

In  figure  4  the  train  carshell  and  multibody  model  are  shown  schematically.  The  end 
underframe  is  modeled  with  13  rigid  bodies  and  10  flexible  bodies,  connected  by  26  plastic 
hinges. 

For  the  initial  design,  all  the  constraints  are  satisfied  which  means  that  the  structure  for  the 
low  speed  simulation  can  allow  higher  levels  of  deformation.  During  the  optimization  process 
the  acceleration  levels,  for  the  30  km/h  simulation  are  reduced  with  the  increase  in 
deformation  levels  for  the  low  velocity  simulation  (5  Km/h).  At  the  optimal  design  all  the 
design  constraints  are  satisfied  so  no  plastic  deformation  occurs.  This  is  achieved,  reducing 
the  sections  of  the  beams. 
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_ TABLE  III.  End-underframe  optimization  problem 

Design  Function  VCSI  =  —  f  a2  dt  „  ,A1  . , 

T  J  V  =  30  km  /  h 

Design  Constraints  Mp.  <  M ^  |y  =  5  /  h  (i=l, ...  7) 

Design  variables  Width  of  the  I  beams  (figure  4) 


TABLE  IV.  End-underframe  optimization  results 


Design  Function 

Initial 

20.2 

Optimal 

13.6 

b]  (mm) 

120 

97.36 

Design  variables  b2  (mm) 

100 

75.3 

b3  (mm) 

150 

130.38 

Critical  Design  Constraint 

4.71X10"' 

-9.06X1 0"J 

4.4.  DESIGN  OF  A  3D  VEHICLE  CHASSIS  UNDER  DYNAMIC  LOADS 

The  design  of  a  vehicle  chassis  under  the  action  of  dynamic  loads,  using  the  3D  tools,  is 
herein  presented.  The  vehicle  model  comprises  four  wheels  connected  to  the  flexible  chassis 
by  a  simplified  suspension  system.  A  simplified  unidirectional  tire  model  is  used  in  the 
simulation.  For  the  optimization  of  the  chassis,  two  bump  conditions  are  considered  in  order 
to  induce  dynamic  bending  and  torsion.  The  mass  of  the  chassis  is  chosen  as  the  design 
function  to  be  minimized.  Concerning  the  design  variables,  the  chassis  is  divided  in  three 
different  zones,  identified  in  figure  5,  for  each  one  a  design  variable  is  considered, 
corresponding  to  the  thickness  of  the  hollow  circular  section  beams  of  the  chassis. 
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bi  b2  - b3 


MODEL 

-  4  wheels 

-  Flexible  chassis:  5 1  nodes, 

91  beam  elements;  306  DOF 

3D  Model  of  the  vehicle  chassis 

The  optimal  design  problem  of  the  vehicle  chassis  is  presented  in  table  V.  The  results  are 
presented  in  table  VI. 


TABLE  V.  Optimal  design  problem  of  the  Vehicle  Chassis 


Design  Function 

Total  Mass  of  the  Vehicle 

Design  Constraints 

C/ 

^aadm  i=l,..,2*NLC*Nele*Ncc 

Number  of  load  cases  (Nlc) 

2 

Number  of  elements  (Neie) 

91 

Maximal  admissible  stress  aadm  (Mpa) 

200 

Number  of  critical  stress  constraints  per 

9 

element  (Ncc) 

Total  number  of  design  constraints 

364 

Design  Variables 

bk  =  tk 

Number  of  design  variables 

3 

Initial  design  vector  (b7)  (mm) 

{5  5  5} 

Lower  limits  vector  (b7)  (mm) 

{0.5  0.5  0.5} 

Upper  limits  vector  (b7)  (mm) 

(50  50  50} 

TABLE  VI.  Optimization  results  of  the  Vehicle  Chassis 

Initial 

Optimal 

Objective  Function  (Mass) 

262.1 

63.4 

bi  (mm) 

5.0 

3.49 

Design  Variables  b2  (mm) 

5.0 

1.33 

b3  (mm) 

5.0 

0.97 

Critical  Design  Constraint 

-0.567 

0.0 

Figure  5. 


For  the  initial  design,  the  section  of  the  beams  of  the  chassis  are  clearly  oversized,  being 
the  value  of  the  maximum  stress  in  the  chassis  (86  Mpa)  considerably  below  the  allowable 
maximum  stress  (200  MPa).  The  optimization  process  drives  to  a  global  reduction  of  the 
thickness  of  the  beam  sections,  with  the  consequent  decrease  of  the  weight  of  the  chassis  and 
the  increase  of  the  stresses.  For  the  optimal  design,  it  is  observed  that  the  largest  thickness  of 
the  beam  sections  corresponds  to  the  frontal  zone  (variable  bi)  and  the  zone  of  smaller 
thickness  is  the  lateral  panels.  For  the  optimal  design,  two  of  the  design  constraints  are  active 
and  the  remaining  ones  are  verified.  The  active  design  constraints  correspond  to  the  traversal 
beams  of  the  roof  in  the  zone  of  the  passenger’s  compartment.  These  active  design  constraints 
occur  for  the  torsion  ride,  which  shows  that  in  this  case  the  critical  loads  correspond  to  torsion 
conditions. 
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5.  Conclusions 

General  design  methodologies  for  rigid-flexible  multibody  systems  have  been  presented. 
These  methodologies  that  are  based  on  rigid-flexible  multibody  dynamics  formulations  have 
been  linked  with  general  optimization  algorithms  and  include  numerical  and  analytical 
sensitivities. 

The  methodologies  presented  have  been  applied  to  the  design  for  vehicle  crashworthiness.  ID 
model  have  been  used  to  simulate  collisions  between  trains,  where  overall  deformations, 
accelerations,  forces  and  absorbed  energies  are  obtained.  ID  design  tools  have  been  applied  to 
the  specification  of  the  energy  absorption  devices.  These  methodologies  have  been  applied 
and  validated  with  a  range  of  commercial  trains  and  collision  scenarios.  2D  models,  where  the 
plastic  deformations  are  modeled  using  plastic  hinges,  have  been  used  to  simulate  end- 
underframes  of  trains  under  impact.  Multiload  design  concepts  that  allow  simulating  impacts 
at  different  velocities  have  been  used  in  the  design  process,  and  applied  to  the  design  of  an 
end  underframe  of  a  train,  allowing  reducing  the  acceleration  levels  in  the  structure  without 
any  plastic  deformation  for  the  service  loads.  Analytic  sensitivities  based  on  the  direct 
differentiation  method  have  proved  its  efficiency  for  this  kind  of  time-consuming  problems. 
ID  and  2D  models  provide  computationally  efficient  and  sufficiently  accurate  tools,  which 
are  to  be  used  in  earlier  design  stages. 

Finally  these  design  methodologies  have  been  applied  for  the  design  of  a  3D  vehicle  chassis 
under  dynamic  solicitations.  When  compared  with  the  classical  structural  design  techniques 
that  use  only  static  load  conditions,  the  methodology  proposed  allows  the  design  of  the 
vehicle  chassis  under  dynamic  loads,  which  result  from  transposition  of  obstacles  or  vehicle 
trajectories. 
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ABSTRACT 

The  dynamic  analysis  of  a  roller  coaster,  or  any  other  type  of  rail-guided  vehicle,  requires  that  a  suitable 
description  of  the  track,  for  the  multibody  model,  is  available.  In  this  communication  the  development  and 
implementation  of  an  appropriate  methodology  for  the  accurate  description  of  a  roller  coaster  track  spatial 
geometry,  in  the  framework  of  multibody  dynamics,  is  presented.  Depending  on  the  specific  application  the  track 
geometry  can  be  described  by  different  types  of  parametric  curves.  In  this  work,  three  types  of  track  geometric 
descriptions,  using  cubic  splines,  Akima  splines  and  shape  preserving  splines,  are  discussed.  The  track 
description  adopted  uses  Frenet  frames,  which  provide  the  appropriate  track  referential  at  every  point.  For  the 
complete  characterization  of  the  track,  the  cant  angle,  defined  here  as  the  roll  of  the  osculating  plane  about  the 
longitudinal  tangent  vector,  is  also  considered.  Taking  into  account  that  most  of  the  rail  geometry  is  time 
invariant,  a  pre-processor  is  used  to  define  the  nominal  geometry  of  a  roller  coaster  track  based  on  the 
interpolation  of  a  discrete  number  of  points  given  by  the  user.  In  order  to  achieve  computational  efficiency,  the 
pre-processor  generates,  in  a  tabular  manner  and  as  a  function  of  the  rail  length,  all  the  track  position  data  and 
other  general  quantities  required  for  the  multibody  code.  At  every  time  step,  the  program  interpolates  linearly  the 
railway  database  in  order  to  form  a  track  kinematic  constraint  that  enforces  the  vehicle  model  to  have  its 
wheelsets  constrained  to  move  along  the  track  with  a  prescribed  angular  orientation  with  respect  to  the  railway 
Frenet  frames.  The  advantages  and  drawbacks  of  this  formulation  are  discussed  emphasizing  the  influence  of  the 
type  of  parametric  curves  used  to  construct  the  database  that  describe  the  track  geometry.  The  discussion  is 
supported  through  the  application  of  the  formulation  to  a  roller  coaster  model  with  complex  rail  geometry. 

1  Introduction 

The  dynamic  analysis  of  railway  [1-3],  roller  coaster  [4]  or  any  other  type  of  rail-guided  vehicles  requires 
an  accurate  description  of  the  track  geometry.  The  track  is  composed  of  two  rails  defined  in  a  plane  that  sits  in  a 
spatial  curve,  defined  hereafter  as  the  reference  path.  The  basic  ingredient  to  define  the  track  is,  therefore,  the 
geometry  of  the  reference  path.  Typically,  the  track  irregularities  can  be  modeled  by  adding  to  the  track  perfect 
geometry  small  perturbations  that  are  either  measured  experimentally  or  generated  numerically.  The  objective  of 
this  work  is  to  present  a  description  of  the  spatial  geometric  features  of  the  tracks,  and  its  computational 
implementation,  in  a  form  suitable  to  the  multibody  methodology  adopted  for  the  modeling  of  railway  systems. 
The  introduction  of  the  track  irregularities  is  not  considered  in  this  work. 

Depending  on  the  specific  application,  the  reference  path  of  the  track  geometry  can  be  described  by  a 
number  of  types  of  parametric  curves  [5],  For  railway  and  light  track  vehicles  the  description  of  the  nominal 
geometry  of  the  track  is  generally  done  by  putting  together  straight  and  circular  track  segments,  interconnected 
by  transition  segments  that  ensure  the  continuity  of  the  first  and  second  derivatives  of  the  railway  in  the 
transition  points  [1,6].  For  other  applications,  parametric  curves  that  interpolate  a  given  number  of  control  points 
are  commonly  used  to  define  the  track  geometry.  In  any  case,  the  complete  characterization  of  the  tracks  also 
requires  the  definition  of  the  cant  angle  variation  along  the  reference  path.  For  flat  tracks,  the  cant  angle  in  a 
given  point  of  the  reference  path  is  measured  in  the  plane  perpendicular  to  the  reference  path,  between  a  line  that 
seats  on  both  rails  and  the  horizontal  plane.  For  tracks  with  a  full  spatial  geometry,  a  new  definition  of  this  angle 
is  introduced.  It  is  proposed  that  the  osculating  plane  [5]  of  the  reference  track  plays  the  role  of  the  horizontal 
plane  of  the  flat  track  in  measuring  the  cant  angle. 

In  this  work  three  types  of  track  geometric  descriptions  are  discussed  in  the  framework  of  the  multibody 
models  for  railway  dynamics  analysis,  i.e.,  cubic  splines  [10,11],  Akima  splines  [16,20]  and  shape  preserving 
splines  [20].  The  application  of  cubic  splines  to  interpolate  a  set  of  control  points  describing  the  track  geometry 
leads  to  undesired  oscillations  in  the  track  model  [12].  Other  methodologies  using  Akima  splines  or  shape 
preserving  splines  are  alternative  interpolation  techniques  for  the  parameterization  of  the  reference  path 
geometry  that  minimize  the  undesired  oscillations  of  the  interpolated  curve. 

The  reference  path  parameterization  with  analytical  segments,  which  use  straight,  circular  and  transition 
curves,  does  not  introduce  unwanted  oscillations  on  the  track  geometry.  However,  this  description  is  rather 
complex  to  model  railways  with  large  slopes  or  with  vertical  curves.  Some  of  the  commercial  codes,  that  adopt 
this  description,  impose  that  the  tracks  are  basically  horizontal  in  order  to  avoid  difficulties  [7—9].  Therefore,  the 
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track  description  with  analytical  segments  cannot  be  used  to  parameterize  fully  spatial  geometries  like  the  ones 
used  on  roller  coasters. 

Regardless  of  the  form  in  which  the  reference  path  geometry  is  described,  a  suitable  kinematic  constraint 
must  be  defined  in  order  to  enforce,  not  only  that  a  particular  point  of  given  body  of  the  multibody  systems 
follows  the  reference  path,  but  also  that  the  body  orientation  does  not  change  with  respect  to  a  Frenet-frame  [5] 
associated  to  the  curve.  The  methodology  proposed  here  for  the  general  spatial  curve  joint  can  use  any 
descriptive  form  for  the  reference  path.  The  position,  the  Frenet-frame  vectors  and  their  derivatives,  which  are 
used  in  the  definition  of  the  kinematic  constraint,  are  pre-processed  and  included  in  a  table  as  function  of  the 
curve  length.  Therefore,  during  the  dynamic  analysis  the  quantities  involved  in  the  general  spatial  curve  joint  are 
obtained  by  linear  interpolation  of  the  tabulated  values.  The  spatial  curve  constraint  is  implemented  in  the 
general  purpose  multibody  computer  program  “ DAP- 3D ”  [13], 

2  Analytic  Properties  of  Parametric  Curves 

The  definition  of  the  general  spatial  curve  kinematic  constraint  requires  a  rather  elaborate  geometric 
description  of  the  parametric  curves  used  to  describe  the  track  geometry.  In  this  section  only  the  analytic 
properties  that  are  important  for  the  definition  of  the  kinematic  constraint  are  presented.  Additional  information 
can  be  obtained  in  [5,17,18]. 

2.1  PARAMETRIC  CURVES 

A  parametric  curve  is  a  point-bounded  collection  of  points  that  have  Cartesian  coordinates  given  by 
continuous,  one-parameter,  single-valued  mathematical  functions  [5],  Considering  u  as  the  parametric  variable, 
the  coordinates  of  any  point  on  a  parametric  curve  are  treated  as  the  components  of  the  vector  g(w)  given  by: 

g  =  g(u)  =  {  x(u)  y(u )  z{u)  }T  (1) 

2.2  FRENET  FRAMES  AND  THE  OSCULATING  PLANE 

In  order  to  define  the  spatial  curve  kinematic  constraint  it  is  necessary  to  obtain  the  local  properties  of  the 
curve,  depicted  in  Figure  1,  at  every  point.  A  set  of  three  orthogonal  vectors  t,  n  and  b,  representing  a  moving 
frame  known  as  Frenet  frame  [5,17,18],  needs  to  be  defined. 


The  osculating  plane,  at  a  given  point  P  on  a  curve,  is  defined  as  the  plane  of  closest  contact  to  the  curve  in 
the  neighborhood  of  P.  This  geometric  property  can  be  used  to  define  the  cant  angle.  Therefore,  it  is  proposed 
here  that,  for  tracks  with  a  full  spatial  geometry,  the  cant  angle  is  measured  with  respect  to  the  osculating  plane. 


2.3  UNIT  TANGENT,  NORMAL  AND  BINORMAL  VECTORS 

On  a  parametric  curve,  the  tangent  vector  at  point  P  is  denoted  by  g“,  which  is  obtained  by  differentiating 
the  point  position  g(u)  with  respect  to  the  parametric  variable.  Considering  that  when  u  appears  as  a  superscript, 
it  indicates  differentiation  with  respect  to  u,  the  unit  tangent  vector  to  the  curve  at  point  g(u)  is  given  by  [5]: 


t  = 


(2) 
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The  principal  normal  vector  at  point  g (u)  is  normal  to  the  curve  and  must  lie  in  the  plane  normal  to  the  unit 
tangent  vector.  Among  the  many  possible  normal  vectors,  the  principal  unit  normal  vector,  n,  points  towards  the 
spatial  center  of  curvature  of  the  curve  and  is  given  by  [5]: 


e““V 

g‘ 


k 

Ik! 


(3) 


where  g™  is  the  second  derivative  of  g(n)  with  respect  to  the  parameter  u.  For  the  definition  of  the  Frenet  frame 
associated  to  a  reference  path,  another  vector  normal  to  the  curve  must  be  defined.  Using  the  principal  tangent 
and  normal  vectors,  given  by  equations  (2)  and  (3),  the  third  vector,  denominated  by  binormal  vector,  is  defined 
as  [5]: 

b  =  t  n  (4) 


2.4  ARC  LENGTH 

The  arc  length  is  a  global  characteristic  of  the  curve  that  does  not  vary  from  point  to  point.  The  length  of  a 
parametric  curve  g (u)  is  given  by  [5]: 


L=  jJT^du  (5) 

3  General  Spatial  Curve  Kinematic  Constraints 

In  this  section,  the  formulation  of  the  general  spatial  curve  kinematic  constraints  are  presented  and  the 
developed  methodology  is  implemented  in  the  computer  program  DAP-3 D  [13].  These  constraints  are  the  basis 
of  track  definition  for  rail-guided  vehicles  enforcing  that,  not  only  the  railway  path  is  followed,  but  also  the 
spatial  orientation  of  the  wheelset  is  prescribed,  according  to  the  railway  characteristics  defined  by  the  moving 
Frenet  frame. 

3 . 1  PRESCRIBED  MOTION  CONSTRAINT 

The  objective  here  is  to  define  the  constraint  equations  that  enforce  a  certain  point,  of  a  given  rigid  body,  to 
follow  a  reference  path  [19].  Consider  a  point  R,  located  on  a  rigid  body  i,  that  has  to  follow  a  specified  path,  as 
depicted  in  Figure  2.  The  path  is  defined  by  a  parametric  curve  g (L),  which  is  controlled  by  a  global  parameter  L 
that  represents  the  length  traveled  by  the  point  along  the  curve  until  the  current  location  of  point  R.  The 
kinematic  constraint  is  written  as: 

=  r*-g(L)=0  (6) 

where  r*  =  r,  +  A(  sf  are  the  coordinates  of  point  R  with  respect  to  the  global  coordinate  system,  r(.  is  the 
vector  that  defines  the  location  of  the  body-fixed  coordinate  system,  A,,  is  the  transformation  matrix  from  the 

body-fixed  coordinates  to  the  global  frame  and  sf  are  the  coordinates  of  point  R  with  respect  to  the  body-fixed 
frame.  The  vector  g(I)={x(L),  y{L),  z{L)}T  represents  the  Cartesian  coordinates  of  the  curve  where  point  R  is 
constrained  to  move  and  L  is  the  curve  parametric  variable.  The  velocity  and  acceleration  equations,  associated 
to  these  kinematic  constraints,  are  obtained  as  the  first  and  second  time  derivatives  of  equation  (6).  The  complete 
formulation  can  be  found  in  [22], 
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Figure  2  -  Prescribed  motion  constraint 


3.2  LOCAL  FRAMES  ALIGNMENT  CONSTRAINT 

The  second  part  of  the  spatial  curve  kinematic  constraints  ensure  that  the  spatial  orientation  of  a  body 
remains  unchanged  with  respect  to  the  moving  Frenet  frame,  as  represented  in  Figure  3.  Consider  a  rigid  body  i 
where  (m,  un,  u;),  are  the  unit  vectors  associated  to  the  body-fixed  coordinate  system.  Consider  also  that  the 
Frenet  frame,  of  the  curve  g (I),  is  defined  by  the  unit  vectors  (t,  n,  b)i.  Assume  that,  at  the  initial  time  of 
analysis,  the  relative  orientation  between  the  body  vectors  (u5,un,u?),  and  the  curve  local  frame  (t,  n,  b)7  are  such 
that  the  following  equations  hold 
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Figure  3  Local  frame  alignment  constraint 


With  the  purpose  of  having  a  more  compact  notation,  consider  the  transformation  matrix  from  the  body 
fixed  coordinates  to  the  global  coordinate  system  and  let  the  following  unit  vectors  be  defined  as: 


A-  =  [  ].  i  «/  =  {1  0  0}7  ;  u,  =  {0  1  0}7 

Hence,  the  equation  (7)  can  be  re-written  as 


u,  =  {0  0  l}7 
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The  velocity  and  acceleration  equations,  associated  to  these  kinematic  constraints,  are  obtained  as  the  first 
and  second  time  derivatives  of  equation  (9).  The  complete  formulation  can  be  found  in  [22], 


4  Pre-Processor  for  Railway  Geometric  Description 

For  multibody  analysis,  the  track  models  must  be  defined  in  the  form  of  parameterized  curves.  Here,  three 
different  parametric  track  descriptions,  using  cubic  splines,  Akima  splines  and  shape  preserving  splines,  are 
presented.  A  pre-processor  program  uses  these  parametric  descriptions  in  order  to  define  the  nominal  geometry 
of  a  railway  using  a  discrete  number  of  points,  which  are  organized  in  a  database  as  function  of  the  curve  length 
parameter.  ° 


4.1  CURVE  FOR  THE  REFERENCE  PATH  BY  CUBIC  SPLINES  INTERPOLATION 

The  reference  path  curve  can  be  described  using  cubic  spline  curves  that  interpolate  a  set  of  control  points 
given  by  the  user,  and  ensure  the  continuity  of  their  first  and  second  derivatives.  A  parametric  cubic  curve  is 
defined  as  [10]: 


g(n)-a3  u3 +a2  m2 +a,  m +  a0  (10) 

where  g(u)  are  the  coordinates  of  a  point  on  the  curve,  u  is  the  parametric  variable  and  a,  are  the  unknown 
algebraic  coefficients.  Let  a  set  of  points  g„  representing  the  reference  path,  be  defined  by  their  coordinates 
{x,y,z)i.  When  the  cubic  spline  segments  are  used  to  represent  the  interpolation  curve,  the  algebraic  coefficients  a, 
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are  written  explicitly  in  terms  of  the  boundary  conditions.  In  this  sense,  the  equations  of  the  cubic  splines 
segments  are  given  by  [10] 


g  ( u )  =  [m3  u 2  u 


'2-2  1  llfg(O)' 

j-i  -3  3-2-1  g(l) 

-I  0  0  1  0  I  g'(0)  ’ 

10  0  oJ[g'(l). 


(11) 


where  the  spline  local  parameter  ue[0,l]  and  g(0)  and  g(l)  represent  the  coordinates  of  the  end  points  of  each 
segment.  The  spline  derivatives,  g'(0)  and  g'(l),  at  the  end  points  are  calculated  in  order  to  ensure  C  continuity 
between  spline  segments  and,  for  this  case,  it  is  assumed  that  natural  splines  are  used  [10,11,16], 

In  order  for  the  cubic  spline  to  be  used  in  the  spatial  curve  kinematic  constraint,  its  geometric  characteristics 
must  be  expressed  as  function  of  the  reference  path  length  L,  measured  from  its  origin,  and  not  as  a  function  of 
the  spline  parametric  variable  u.  The  relation  between  L  and  u  is  given  by 

M«)  =  l40+C“>)  (12) 

n  =  1 


where  k  is  the  number  of  the  spline  segment  where  the  point  is  located,  L°  is  the  length  of  the  i‘h  spline  segment 
and  Lactual(u)  represents  the  length  of  the  actual  spline  segment  from  its  origin  to  the  actual  location  of  the  point 
[22], 

In  order  to  implement  the  spatial  curve  kinematic  constraint  in  the  computer  code  it  is  necessary  to  find  the 
value  of  the  cubic  spline  parametric  variable  u  that  corresponds  to  a  prescribed  segment  length  L.  It  is  clear  from 
equations  (12)  and  (5)  that  the  relation  between  these  two  parameters  is  not  linear.  Consider  the  parametric 
variable,  uR,  corresponding  to  a  point  R,  located  on  the  Uh  cubic  spline  segment,  and  to  which  it  is  associated  a 
curve  length  L* ,  measured  from  the  k'h  segment  origin.  In  this  case,  the  parameter  u  is  obtained  from  the 
parameter  L  using  [22] 


This  non-linear  equation  is  solved  using  the  Newton-Raphson  method  [11,13]. 


4.2  CURVE  FOR  THE  REFERENCE  PATH  BY  AKIMA  SPLINES  INTERPOLATION 

The  reference  path  parameterization  with  Akima  cubic  splines  has  the  objective  of  minimizing  the 
undesired  wiggles  of  the  curves  observed  on  the  cubic  spline  interpolation  [16].  This  formulation  is  implemented 
in  the  pre-processor  using  the  FORTRAN  subroutines  as  implemented  in  the  IMSL  math  library  [20].  The  pre¬ 
processor  uses  the  routine  DCSAKM  [20],  from  IMSL  library,  to  compute  three  Akima  cubic  splines  that 
interpolate  the  sets  of  data  points  (u„  x,),  (uu  yt)  and  («,,  z,),  where  xh  y,  and  z,  are  the  Cartesian  coordinates  of  the 
N  control  points  to  interpolate.  The  parametric  curve  obtained  consists  of  three  piecewise  cubic  polynomials 
[16,20]  written  as 

c»  +4  («-«;)  +  + 

<  +4  («-«;■)  +  y(«-w,)2  +  “  ("~i7/)3 

c£.  +<£(«-«,)  +  y(w-7,)2  + 

where  g(w)  is  a  point  on  the  curve,  u  is  the  parametric  variable,  c*;,  Cj,  and  c£  are  the  local  polynomial 
coefficients  that  must  be  calculated,  and  ui  are  the  breakpoints  of  the  Akima  cubic  splines,  which  are  assumed 
to  be  strictly  increasing. 

The  advantage  of  the  Akima  splines  parameterization  is  that  no  unwanted  oscillations  are  introduced  by  the 
interpolation  algorithm  in  geometric  description  of  the  track.  Nevertheless,  this  interpolation  scheme  only 
ensures  C1  continuity  between  spline  segments.  Therefore,  the  continuity  of  the  reference  path  curvature  is  not 
ensured,  which  may  conflict  with  some  of  the  properties  required  for  railway  geometries  [6], 
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4.3  CURVE  FOR  THE  REFERENCE  PATH  BY  SHAPE  PRESERVING  SPLINES 
INTERPOLATION 

The  shape  preserving  cubic  splines  are  spline  functions  that  preserve  the  concavity  of  the  interpolation  data 
[16,20,21],  This  interpolation  scheme  is  implemented  in  the  pre-processor  using  the  Fortran  subroutines 
implemented  in  the  IMSL  math  library  [20].  The  pre-processor  uses  the  routine  DCSCON  [20],  from  IMSL 
library,  to  compute  the  shape  preserving  cubic  splines  that  interpolate  the  sets  of  data  points  («,,  *’),  (M„  y)  and 
(w„  z,),  where  x„  y,  and  z,  are  the  Cartesian  coordinates  of  the  control  points,  =  /,  ...  ,  N  is  the  parametric 
variable  of  the  cubic  curve  corresponding  to  each  control  point,  and  N  is  the  number  of  control  points  to 
interpolate.  The  parametric  curve  obtained  consists  of  three  piecewise  cubic  polynomials  [20],  written  as 
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where  g (u)  is  a  vector  with  the  coordinates  of  a  point  on  the  curve,  u  is  the  parametric  variable  c1  cy  and  cz 

are  the  local  polynomial  coefficients  that  must  be  calculated,  u* ,  UJ  and  u'k  are  respectively  the  Nx,  Ny,  and  N, 

breakpoints  for  x(u),  y(u)  and  z(u)  of  the  shape  preserving  cubic  splines,  which  are  assumed  to  be  strictly 
increasing. 

The  advantage  of  the  shape  preserving  splines  parameterization  is  that  it  is  consistent  with  the  concavity  of 
the  data,  which  is  rather  useful  when  it  is  important  to  preserve  the  convex  and  concave  regions  implied  by  the 
control  points.  This  interpolation  scheme  also  ensures  C2  continuity  between  spline  segments,  i.e,  it  guarantees 
that  the  parameterized  curve  has  a  continuous  curvature. 

4.4  INTRODUCTION  OF  A  PRESCRIBED  CANT  ANGLE  IN  THE  KINEMATIC 
CONSTRAINT 

In  horizontal  curves  the  outer  rail  is  usually  raised  in  order  to  reduce  the  effects  of  the  centrifugal 
acceleration  on  vehicles  [3],  In  this  sense,  the  railway  cant  has  to  be  taken  into  account  by  the  pre-processor 
when  creating  the  railway  databases.  The  cant  angle  is  defined  here  as  the  angle  between  vector  n  and  the 
osculating  plane,  being  measured  in  the  normal  plane,  as  described  in  Figure  4. 


(15) 


Let  the  track  cant  angle,  on  a  point  R  of  the  parametric  curve  g(L),  be  designated  by  (p„.  Assume  that  the 
reference  path  Frenet  frame  is  defined  by  its  principal  unit  vectors  (t,n,b)i.  Thus,  due  to  the  track  cant,  the 
parametric  curve  reference  frame  rotates  about  the  t  axis  by  an  angle  (p*,  as  shown  in  Figure  4.  Therefore,  it  is 
necessary  to  calculate  the  new  components  of  the  principal  unit  vectors  (tR,nR,bR)L  of  the  curve  moving  frame 
after  the  cant  angle  rotation.  According  to  [22],  the  new  components  are  expressed  as: 

t*=t 

n*  =n  cos((pfl)  +  b  «'n((ps)  (16) 

b*  =  -n  jii^)  +  b  cos((p*) 

With  this  formulation,  the  user  must  set  the  cant  angle  for  the  beginning  and  for  the  end  of  every  track 
segment.  The  values  of  the  cant  angle  are  linearly  interpolated  between  the  segment  end  points,  regardless  of  the 
parametric  description  of  the  curve.  With  the  complete  information  available,  the  pre-processor  program  uses 
equation  ( 1 6)  to  calculate  the  geometric  parameters  that  define  the  reference  path  geometry. 
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4.5  TRACK  INFORMATION  INCLUDED  IN  RAILWAY  DATABASE 


The  direct  use,  in  the  spatial  curve  constraints,  of  the  equations  obtained  by  any  of  the  parametric 
descriptions  presented,  is  neither  practical  nor  efficient  from  the  computational  point  of  view.  As  the  kinematic 
constraints  is  to  be  used  in  the  framework  of  a  dynamic  analysis  program,  the  solution  of  the  nonlinear  equations 
(13)  and  the  sets  of  equations  (1 1),  (14),  (15)  and  (16)  and  so  forth  at  every  time  step  would  be  an  heavy  burden 
on  the  code.  An  alternative  implementation  of  these  equations  is  the  construction  of  a  lookup  table  where  all 
quantities  appearing  in  the  definition  of  the  kinematic  constraints  are  tabulated  as  function  of  the  global  length 
parameter. 

After  selecting  any  of  the  parametric  descriptions  of  the  spatial  curve  presented,  the  length  parameter  step 
AL  adopted  for  the  database  construction  has  to  be  chosen.  Then,  the  pre-processor  program  automatically 
constructs  the  lookup  table  with  all  parameters  necessary  to  define  the  geometric  characteristics  of  the  reference 
path,  taking  into  account  the  track  cant  variation.  These  geometric  parameters  are  organized  in  columns  as 
function  of  the  length  parameter  L  of  the  track.  Then,  the  multibody  code  interpolates  linearly  the  table  in  order 
to  obtain  all  required  quantities  to  set  the  constraints.  Figure  5  presents  the  structure  of  the  railway  database 
obtained  with  the  pre-processor. 
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Figure  5  -  Structure  of  reference  path  geometric  information  table 


5  Application  Example 

The  discussion  of  the  methodology  proposed  for  the  general  spatial  curve  constraint  is  carried  here  based  on 
an  application  example.  It  concerns  the  application  to  a  three-dimensional  track  model  with  the  geometry 
illustrated  in  Figure  6,  which  is  analogous  to  the  ones  used  on  roller  coasters  design  [4], 

Three  alternative  roller  coaster  models  are  built  using  cubic,  Akima  and  shape  preserving  splines.  The  track 
models  are  first  pre-processed  and  the  relevant  geometric  information  is  included  in  the  railway  databases.  The 
roller  coaster  model  is  assembled  considering,  for  the  horizontal  curve  G-I,  transition  curves  with  lengths  of  60 
m  each.  The  cant  angle  for  this  circular  curve  is  -1.014  rad  (-58.1°)  and  it  varies  linearly  in  the  transition 
segments. 


K 


In  Figure  7,  a  graphic  that  represents  the  z  Cartesian  coordinate  of  the  roller  coaster  model  built  using  cubic, 
Akima  and  shape  preserving  splines,  is  presented.  This  graphic  is  drawn  as  function  of  the  track  length  L,  in  the 
neighborhood  of  point  B,  from  Figure  6,  and  for  a  control  point  increment  of  1  m.  As  it  can  be  seen,  the  curve 
parameterized  with  cubic  splines  leads  to  oscillations  in  the  transition  between  the  straight  segment  and  the 
circular  segment.  The  other  two  parameterization  schemes  do  not  exhibit  oscillations,  and  preserve  the  shape  of 
the  data. 

As  the  emphasis  of  this  work  is  the  track  model  and  not  the  vehicle  model  itself,  only  a  single  rigid  body, 
representing  a  roller  coaster  vehicle,  is  considered  for  the  dynamic  analysis  performed  here.  Figure  8  represents  a 
view  of  the  roller  coaster  vehicle  at  the  entrance  of  the  looping,  i.e.,  at  point  D  in  Figure  6.  This  result  was 
obtained  during  dynamic  analysis,  using  Akima  splines  for  track  description,  and  correspond  to  a  constraint 
violation  of  2.9x10''.  The  violation  occurs  in  the  second  constraint  of  equation  (9),  i.e.,  the  perpendicularity 
between  the  unit  vector  u4,  associated  to  the  axis  of  the  body-fixed  coordinate  system  and  the  binormal  vector  b 
of  the  Frenet  frame  associated  to  the  reference  path  curve.  Moreover,  when  comparing  the  maximum  constraint 
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violations  obtained  during  dynamic  analyses,  using  the  different  track  descriptions,  it  is  observed  that  the 
reference  path  curves  parameterized  with  Akima  splines  produce  maximum  constraint  violations  proportional  to 
10  while  for  the  other  interpolation  schemes  the  constraint  violations  are  proportional  to  10'  .  This  can  be 
explained  by  the  fact  that  the  track  curve,  described  by  Akima  splines,  only  has  C;  continuity,  not  ensuring  the 
continuity  of  the  curvature.  Once  the  results  obtained  using  Akima  splines  for  track  parameterization  are  not 
satisfactory,  this  interpolation  method  is  not  considered  hereafter. 
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Figure  7  -  z  Cartesian  coordinate  of  the  roller  coaster  model 


Figure  8  -  View  of  the  roller  coaster  vehicle  at  the  looping  entrance  using  Akima  splines  for  track  description 

The  roller  coaster  vehicle  accelerations  in  the  z  direction,  for  the  track  models  obtained  with  cubic  and 
shape  preserving  splines,  are  presented  in  Figure  9.  As  it  can  be  seen,  there  is  a  good  agreement  between  the 
results  obtained  with  the  two  forms  of  parameterization.  The  large  peaks  of  acceleration  observed  are  direct 
results  of  the  sudden  change  of  the  vertical  curvature  between  parts  of  the  track  with  different  geometric 
characteristics.  These  sudden  changes  reflect  the  fact  that  no  vertical  transition  curves  are  used  in  this  roller 
coaster  design.  The  smaller  perturbations  observed  in  the  results,  result  from  the  oscillations  interpolation 
processes  and,  therefore,  do  not  have  a  physical  meaning. 
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Figure  9  -  Acceleration  of  the  roller  coaster  vehicle  in  z  direction  for  distances  between  control  points  of  1  m 


6  Conclusions  and  Future  Developments 

A  kinematic  constraint  representing  a  general  spatial  curve  joint  has  been  developed  here  and  its 
computational  implementation  has  been  presented.  The  strategy  adopted  for  the  computer  implementation  of  the 
joint  starts  by  having  the  spatial  curve  expressed  in  a  parametric  form.  A  moving  reference  frame  is  defined  in 
the  curve  with  its  axis  defined  in  the  intersections  of  the  normal,  osculating  and  rectifying  planes.  The 
introduction  of  the  cant  angle  and  of  its  variation  along  the  curve  has  also  been  implemented.  The  reference 
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plane  used  in  the  spatial  curve  to  define  the  cant  angle  is  the  osculating  plane,  which  is  the  horizontal  plane  in 
case  of  a  flat  curve.  A  transformation  in  the  parameterization  is  proposed  to  replace  the  actual  parameter  by 
another  that  uses  the  arc  length  of  the  curve.  Recognizing  the  fact  that  the  transformation  equations  are  nonlinear 
and  that  it  is  not  efficient  to  calculate  the  curve  vectors  and  their  derivatives  during  the  dynamic  analysis  a  pre¬ 
processor  to  generate  all  geometric  properties  of  the  curve  is  implemented.  The  result  is  a  database  where  all 
quantities  involved  in  the  constraint  are  tabulated  as  function  of  the  arc  length  traveled  by  the  constrained  point 
of  a  system  body  in  the  curve.  This  methodology  has  the  advantage  of  making  the  time  required  for  the  dynamic 
simulation  of  the  rail-guided  vehicle  completely  independent  of  the  track  complexity  and  of  the  type  of 
parametric  curve  used.  Any  descriptive  form  of  parametric  curves  is  dealt  with  in  the  pre-processor  while  the 
dynamic  analysis  program  only  has  to  proceed  with  linear  interpolations  of  the  railway  table.  By  ensuring  that 
the  arc-length  step  is  small  enough  the  linear  interpolation  procedure  does  not  introduce  any  significant  error  in 
the  geometric  description  of  the  curve. 

The  track  parameterization  with  cubic  splines  or  with  shape  preserving  splines  can  be  used  to  describe  the 
track  geometry  of  fully  three-dimensional  roller  coasters.  The  major  drawback  of  the  cubic  splines  formulation  is 
that  it  leads  to  undesired  oscillations  in  the  track  model,  which  can  be  perceived  as  track  irregularities  during 
dynamic  analysis.  The  use  of  shape  preserving  splines  leads  to  the  best  representation  of  the  railway  reference 
path.  Track  parameterization  with  Akima  cubic  splines  is  also  presented  and  it  is  shown  that  it  leads  to  high 
constraint  violations  in  the  transitions  between  parts  of  the  track  with  different  geometric  characteristics.  These 
violations  are  big  enough  to  originate  results  that  are  not  consistent  track  regularity  required,  i.e.,  with  the  need 
for  C2  continuity.  Other  parametric  descriptions  of  the  general  spatial  curve,  such  as  splines  with  tension,  can  be 
implemented  in  the  pre-processor  program  as  alternative  techniques  for  railway  parameterization. 

The  general  spatial  curve  kinematic  joint,  now  described,  serves  as  the  basis  for  the  construction  of  the 
railway  as  it  provides  a  moving  frame,  associated  to  the  curve  where  the  osculating  plane  is  defined  and  with 
respect  to  which  the  cant  angle  is  defined.  The  actual  geometry  of  the  tracks  can  now  be  described  with  respect 
to  this  moving  frame  providing  one  of  the  basic  ingredients  for  the  use  of  the  multibody  code  in  the  context  of 
railway  dynamics. 
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Abstract: 

Simulation  of  complex  engineering  systems  requires  modelling  and  computation  of  com¬ 
ponents  from  different  engineering  fields,  e.g.  multibody  dynamics,  control  and  electron¬ 
ics.  Each  component  can  be  modelled  and  computed  with  its  domain-specific  tool.  But 
nondomain-specific  components  of  the  system  can  not  be  sufficiently  treated  by  these 
tools  resulting  in  unsatisfying  simulations.  It  has  been  shown  that  approaches  for  simu¬ 
lator  coupling  open  a  systematic  and  accurate  way  to  combine  simulation  tools  and  get 
satisfying  results.  Therefore,  the  global  system  has  to  be  decomposed  into  subsystems 
due  to  the  different  engineering  disciplines  using  engineering  intuition  to  treat  it  effi¬ 
ciently  by  a  team  of  engineers.  With  the  iterative  simulator  coupling  method  stabilizing 
the  modular  simulation  the  computation  of  the  global  system  is  realized  by  a  time  dis¬ 
crete  linker  and  scheduler  which  combines  the  inputs  and  outputs  of  the  corresponding 
subsystems  and  establishes  communication  between  them.  In  this  approach  the  commu¬ 
nication  between  the  coupled  simulation  tools  is  executed  at  fixed  time  steps.  However,  if 
the  coupled  modules  are  characterized  by  large  differences  in  their  eigendynamic,  an  in¬ 
crease  of  the  numerical  efficiency  by  an  automatic  communication  step  size  control  can  be 
achieved.  Therefore,  two  methods  of  step  size  control,  Richardson  extrapolation  and  em¬ 
bedded  formula,  are  discussed.  It  is  important  that  the  communication  step  size  control 
does  not  interfeie  with  the  coupled  simulation  tools  because  of  the  subsystems  black-box 
description  within  the  modular  simulation.  It  will  be  shown  that  such  an  automatic  com¬ 
munication  step  size  control  allows  to  minimize  the  quantity  of  communications  between 
the  coupled  subsystems  as  well  as  to  use  well-known  integration  methods  for  each  inde¬ 
pendent  module.  Accordingly,  a  better  efficiency  and  quality  by  a  faster  computation 
can  be  expected  if  the  dynamic  characteristics  of  the  subsystems  show  large  differences. 


1  Introduction 

The  dynamic  analysis  of  complex  engineering  systems  requires  the  modelling  of  compo¬ 
nents  from  different  engineering  fields.  The  modular  decomposition  of  the  global  system 
is  based  on  engineering  intuition  of  corresponding  engineering  disciplines.  Once  the  inter¬ 
faces  of  the  subsystems  have  been  defined  these  subsystems  can  be  modeled  independently 
from  each  other.  The  exchange  and  modification  of  a  subsystem  is  also  independent  from 
any  other  component  as  well  as  different  and  independent  software  tools  can  be  used  for 
every  engineering  discipline. 
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The  overall  simulation  is  achieved  by  coupling  of  all  subsystems  in  order  to  obtain 
the  global  system  behaviour.  For  mechatronic  systems  the  coupling  of  subsystems  may 
be  realized  on  three  different  levels  of  model  description  as  illustrated  in  Figure  1. 
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Figure  1:  Modular  decomposition  and  simulation  of  mechatronic  systems 

In  the  physical  model  description  a  system  is  represented  by  a  physical  model,  e.g. 
in  case  of  multibody  systems  there  are  rigid  bodies,  massless  joints  and  coupling  force 
elements.  The  mathematical  model  description  is  a  representation  of  a  system  by  ma¬ 
thematical  equations  which  can  be  derived  from  the  physical  model  description,  e.g.  the 
equations  of  motion  of  a  multibody  system.  The  simulation  results  of  the  mathematical 
model  description  are  considered  as  the  behavioral  model  description,  e.g.  the  trajectories 
of  position  and  velocity  of  the  bodies. 

Coupling  of  models  in  the  behavioral  model  description  is  referred  to  as  simulator  cou¬ 
pling  or  modular  simulation.  The  simulation  of  the  global  system  is  realized  by  a  time 
discrete  linker  and  scheduler  which  combines  the  inputs  and  outputs  of  the  correspond¬ 
ing  subsystems  and  establishes  communication  between  the  subsystems  to  discrete  time 
instants.  Therefore,  it  is  possible  to  use  different  software  packages  for  each  subsystem 
and  then  to  link  the  solvers  together. 

2  Modular  modelling 

For  a  modular  simulation  the  global  system  has  to  be  decomposed  into  subsystems  which 
are  described  in  a  block  representation.  The  subystems  are  characterized  by  the  blocks’ 
input  vector  u  and  output  vector  y.  It  is  assumed  that  the  ouputs  have  no  feedback 
to  the  inputs  within  one  block.  This  description  can  be  used  for  the  dynamical  analysis 
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without  knowledge  of  the  internal  structure.  A  representation  by  the  well  known  “black¬ 
box”  is  used  which  allows  access  to  the  system  only  by  means  of  the  input  and  output 
terminals,  see  Figure  2. 


input  u 


y  =  Su 


transfer 
function  S 


output  y 


Figure  2:  Black  box  for  modular  modelling 


Then,  the  global  system  consists  of  different  subsystems  with  interconnections  between 
the  corresponding  blocks,  sec  Figure  3. 


Global 
system - 
structure 


Figure  3:  Global  system  structure 


On  this  basis  systems  are  classified  into  feed-through,  which  means  that  input  changes 
result  in  output  changes  without  time  delay  by  internal  dynamics,  and  no  feed-through 
systems.  If  any  interconnections  result  in  a  closed  loop  of  feed-through  subsystems,  then 
an  algebraic  loop  does  exist  which  does  not  allow  explicit  determination  of  all  inputs.  In 
this  case  an  additional  numerical  solution  of  these  algebraic  loops  is  necessary. 


3  Simulator  coupling 

There  are  two  options  for  the  simulation  of  systems  given  in  the  previously  mentioned 
modular  description.  On  one  hand  simulation  tools  which  are  based  on  this  description, 
often  referred  to  as  block  simulators,  can  be  used,  such  as  ACSL  [6]  or  SIMULINK  [5]! 
On  the  other  hand  it  is  possible  to  couple  different  simulation  tools.  The  advantage  of 
block  simulators  is  the  use  of  standard  numerical  integration  methods  with  additional  so¬ 
lution  of  algebraic  loops  if  required.  With  a  sufficiently  exact  solution  of  algebraic  loops, 
the  properties  of  numerical  integration  methods  remain  unchanged.  The  disadvantages 
are  the  requirements  to  supply  all  subsystems  in  one  simulation  tool  and  to  use  the  same 
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numerical  method  for  all  subsystems.  Coupling  of  simulation  tools  allows  subsystems  to 
be  simulated  by  different  programs  avoiding  the  mentioned  disadvantages  of  block  simu¬ 
lators.  But  additional  numerical  problems  may  arise  due  to  the  coupling  with  standard 
solvers  for  each  subsystem. 

Simulator  coupling  requires  that  integration  of  each  subsystem  is  carried  out  with 
extrapolation  of  the  inputs,  followed  by  the  evaluation  of  the  output  equations  of  all 
subsystems.  For  an  arbitrary  number  of  simulators,  each  subsystem  i  can  be  represented 
by  an  integration  and  output  equation  written  as 


4+i  =  ^K)»  (i) 

4+1  =  §'(4+1,4),  i  =  l{l)N.  (2) 

It  is  known,  see  Kubler  [3],  that  zero-stability  for  an  non-iterative  simulator  coupling 
is  only  guaranteed  if  algebraic  loops  do  not  exist  between  the  subsystems.  Otherwise, 
instability  of  the  modular  simulation  may  occur.  For  such  a  simulator  coupling  a  method 
to  obtain  zero-stability  is  required.  In  the  general  case  of  systems  with  algebraic  loops 
non-iterative  solutions  are  not  qualified. 

With  an  iterative  simulator  coupling  the  integration  of  each  subsystem  is  carried 
out  according  to  the  non-iterative  simulator  coupling  with  extrapolation  of  the  inputs, 
followed  by  the  coupled  solution  of  the  output  equations  of  all  subsystems.  For  an 
arbitrary  number  of  simulators,  each  subsystem  i  can  be  written  as 


4+i  =  $'(4),  (3) 

Vk+i  ~  §  (^fc+D  ufc+i)j  i  =  1(1)W  (4) 

In  contrast  to  the  non-iterative  approach  no  extrapolation  is  needed  for  the  input 
vector  which  is  now  found  by  iteration.  The  inputs  of  the  output  equation  can 
be  recursively  eliminated,  leading  to  a  system  of  nonlinear  algebraic  equations  for  the 
outputs  of  the  global  system 


Vk+i  =  *(yk+ 1)  (5) 

which  has  to  be  solved  by  an  iterative  method  for  each  global  time  step.  In  Figure  4 
the  iterative  simulator  coupling  is  illustrated  for  N  =  2  subsystems. 

As  an  iterative  method  the  Gauss-Jacobi  and  Gauss-Seidel  method  can  be  used  but 
they  do  not  guarantee  local  convergence.  Newton’s  method  is  locally  convergent,  however, 
the  Jacobian  is  not  available  generally  in  coupled  simulation.  Consequently,  a  quasi- 
Newton  method  has  to  be  applied  which  uses  an  approximation  to  the  Jacobian.  One  of 
the  most  reliable  quasi-Newton  method’s  is  Broyden’s  method,  see  Broyden  [1],  which 
uses  a  secant  approximation  to  the  Jacobian  and  is  also  locally  convergent. 

With  the  iterative  method  a  stable  modular  simulation  can  be  successfully  executed. 
An  investigation  of  the  dynamics  of  a  vehicle  convoy  with  the  coupled  tools  SIMULINK 
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Figure  4:  Iterative  simulator  coupling 

[5],  SIMPACK  [2]  and  NEWEUL  [4]  showed  a  stable  simulation  result  which  was 
verified  by  experiments  with  two  passenger  cars,  see  Kubler  [3]. 

4  Communication  step  size  control 

Foi  an  efficient  computation  of  systems  changing  strongly  their  dynamic  behaviour  during 
the  numerical  solution  there  are  integration  methods  with  automatic  step  size  control 
available.  Therefore,  nearly  all  simulation  tools  consist  of  such  integration  methods. 
Executing  a  simulator  coupling  it  is  possible  to  use  the  integration  methods  of  each 
coupled  tool  but  there  is  also  a  need  to  control  the  global  time  step  for  the  communication 
between  the  subsystems. 

For  a  communication  step  size  control  two  different  error  estimation  methods  based 
on  the  classical  step  size  control  are  regarded.  The  Richardson-cxtrapolation  estimates 
an  error  by  the  difference  of  two  solutions  computed  by  the  same  integration  method  but 
with  different  step  sizes.  The  error  estimation  based  on  the  embedded  formula  uses  the 
difference  of  two  solutions  computed  by  two  integration  methods  with  different  integration 
order  but  the  same  step  size. 

In  order  to  generate  a  communication  step  size  control  based  on  the  embedded  formula 
each  subsystem  i  has  to  execute  a  global  time  step  from  tk  to  tk+H  by  two  integration 
methods  and  ft  of  different  order,  sec  Figure  5. 

At  the  end  of  this  time  step  the  difference  of  the  new  input  values  serves  for  the  error 
estimation  written  as 


errmT  =||  u{tk  +  H,&)  -  u{tk  +  H ,  ft)  ||  .  (6) 

For  the  communication  step  size  control  based  on  the  embedded  formula  the  subsys¬ 
tems  need  additional  information,  an  access  to  the  system  only  by  means  of  the  input 
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and  output  terminals  can  not  be  guaranteed.  Accordingly,  the  defined  requirements  for 
a  simulator  coupling  can  not  be  met. 

For  a  communication  step  size  control  based  on  the  Richardson-extrapolation  each 
subsystem  i  has  to  execute  a  global  time  step  from  tk  to  tk+H  by  one  integration  method 
with  two  different  step  sizes,  see  Figure  6. 


Figure  6:  Richardson- Extrapolation 

At  the  end  of  this  time  step  the  difference  of  the  new  input  values  serves  for  the  error 
estimation  leading  to 


errmv  HI  uH{h  +  H)  -  u2xh/2(4  +  H)  ||  .  (7) 

In  contrast  to  the  embedded  formula,  the  requirement  not  to  interfere  with  the  coupled 
tools  is  met.  In  Figure  7  the  iterative  simulator  coupling  with  added  communication  step 
size  control  based  on  the  Richardson-extrapolation  is  illustrated  for  N  =  2  subsystems. 
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Figure  7:  Simulator  coupling  procedure 


5  Test  example 

I  he  considered  model  of  a  vehicle  suspension  on  a  flexible  track  is  illustrated  in  Figure  8 
ie  model  consists  of  a  wheel  mass  which  is  connected  by  a  spring-damper-combination 
to  the  vehicle  body  and  by  a  second  spring  to  the  track  mass  connected  by  a  third 
spring  to  the  giound.  I  his  global  system  is  decomposed  into  two  subsystems.  The  first 
subsystem  consists  of  the  spring-damper-combination  cudu  the  wheel  mass  m,  and  the 
second  spring  c2.  The  second  subsystem  consists  of  the  track  mass  m2  and  the  third 
spring  c..  Both  subsystems  are  connected  via  a  node  point.  The  node  motions  as  well  as 
the  force  acting  on  the  node  are  exchanged  by  the  corresponding  inputs  and  outputs  of 
each  subsystem,  see  Figure  8. 

The  simulation  experiment  setup  with  the  given  parameters  illustrates  Figure  9  With 
the  g'vcH  parameters  the  two  eigenfrequencies  of  the  system  follow  as  feigA  *  20 Hz  and 
/e:S  2  ~  1-6 kHz.  With  this  large  difference  in  the  two  frequency  values  the  coupled 
modules  are  characterized  by  large  differences  in  their  eigendynamic  properties  Both 
subsystems  are  modelled  with  the  tool  NEWEUL  [4]  which  generates  the  equations  of 

rr  ”7  °n  ^  t001  NEWM0S  [71  was  applied.  Both  subsystems  use 

e  Runge-Kutta  integration  method  of  4.  order  with  a  local  step  size  h  =  10“5  and  the 

inputs  are  extrapolated  by  a  method  of  3.  order.  The  error  barriers  for  the  control  of  the 
global  time  step  are  chosen  as  1(T3  for  the  relative  and  absolute  error. 

Comparing  computations  with  and  without  communication  step  size  control  the  dif¬ 
ference  of  the  computation  time  can  be  determined.  The  simulation  time  with  variable 
global  step  size  is  about  tsim  ~  8s  while  the  computation  time  with  fixed  global  step  size 
h  requires  about  tsim  fe  29s.  Changing  the  parameters  resulting  in  a  model  with 
similar  eigenfrequencies  a  reduction  of  computation  time  has  not  been  observed  Accord¬ 
ingly  an  increase  of  efficiency  can  be  expected  in  particular  for  subsystems  described  by 
large  differences  in  their  eigendynamics.  7 
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Figure  8:  Model  setup  and  decomposition 


Regarding  the  properties  of  the  communication  step  size  control  the  global  time  step 
depends  on  the  inputs  of  each  module.  For  example,  the  size  of  the  global  time  step 
depends  mainly  on  the  exchanged  force  acting  on  the  node  and  less  on  the  motion  of 
the  node.  Figure  10  illustrates  the  behaviour  of  the  spring  force  and  the  corresponding 
global  time  step. 

The  global  time  step  adapts  to  large  values  in  case  of  small  force  value  changes.  Vice 
versa  having  large  changes  of  the  force  value  small  global  time  steps  have  to  be  used. 
Knowing  the  same  behaviour  from  integration  step  size  control  the  functionality  of  the 
communication  step  size  control  is  approved  by  plausibility. 

6  Summary 

A  block  representation  of  mechatronic  systems  is  presented  in  order  to  decompose  a 
global  system  into  subsystems.  Then,  the  subsystems  are  coupled  by  interconnecting 
their  inputs  and  outputs.  Based  on  that  a  modular  simulation  can  be  executed. 

The  dynamical  analysis  of  the  global  system  is  realized  by  a  time  discrete  linker  and 
scheduler  which  combines  the  inputs  and  outputs  of  the  corresponding  subsystems  and 
establishes  communication  between  them.  This  modular  simulation  is  stabilized  by  the 
iterative  simulator  coupling  method.  An  increase  of  the  numerical  efficiency  by  an  auto¬ 
matic  communication  step  size  control  can  be  achieved.  Therefore,  two  methods  of  step 
size  control  are  discussed,  and  one  of  them  is  recommended  for  engineering  applications. 

The  method  proposed  for  modular  modeling  and  simulation  is  applied  for  a  vehicle 
supension  on  a  flexible  track.  The  advantages  of  the  communication  step  size  control 
are  clearly  described  by  this  example.  Thus,  a  communication  step  size  control  is  recom- 
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Parameters 

nij  =  1.0e02  kg 

C]  =  2.0e04  N/rn 
di  =  1.0c03  Ns/rn 
C'2  ~  1.5e06  N/m 

ni2  =  1.0e02  kg 

cs  =  l.OelO  N/m 


subsystem  1 


subsystem  2 


NEWEUL/NEWM09 


INEWEUL/NEWMOSl 


UNUX 


UNUX 


mbs 


mbs 


.  Runge-Kutta  4 
[  Extrapoj.  3,  Order 


Ul 


Runge-Kutta  4 
Extrapol.  3.  Order 


NEWMOS 
RelErrH  =  10-3 
AbsErrH  =  10“3 


Figure  9:  Simulation  parameters  and  setup 


mended  for  all  kind  of  mechatronic  systems. 
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1.  Introduction 

Virtual  prototyping,  comprising  computational  simulation  and  computational  design,  represents 
an  efficient  way  to  reduce  costs  and  time  of  development  for  new  vehicles  simultaneously.  To 
reach  this  goal  in  the  field  of  railway  vehicles,  an  efficient  modelling  and  simulation  of  complex 
wheel  rail  systems  performing  arbitrary  manoeuvres  under  arbitrary  conditions  is  necessary. 

le  growing  and  often  contradictory  demands  for  a  reduction  of  travel  times,  lower  energy 
consumption,  low-noise  and  environment-friendly  railway  traffic  etc.,  require  for  unconventional 
solutions  in  modern  and  future  railways  designs  far  away  from  the  traditional  wheelset.  Examples 
or  already  applied  or  potential  future  design  principles  are  independently  suspended  wheels 
riven,  steered  or  slip  controlled.  Mechatronic  components  for  the  application  of  car  body  tilting 
techniques  and/or  active/semi-active  suspension  elements  to  increase  ride  comfort  may  help 
urther.  Accordingly,  a  modern  simulation  tool  must  enable  the  engineer  to  examine  and  to 
design  the  more  traditional  as  well  as  those  modern  design  principles. 

The  paper  relates  to  the  multibody  system  simulation  software  Simpack  with  the  main  focus 
being  on  the  simulation  of  wheel-rail  systems;  thereby  the  mentioned  demands  for  a  modern 
sunu  ation  tool  will  be  emphasized.  Besides  a  short  overview  over  multibody  simulation  and  the 
wheel  rail  functionality  two  challenging  applications  are  presented. 


2.  Modelling  of  Railway  Vehicles 

The  multibody  system  (MBS)  approach  is  a  powerful  and  widely  used  method  for  the  description 
and  examination  of  the  system  dynamics  of  mechanical  systems  and  particularly  of  vehicle 
systems.  To  avoid  the  time  consuming  and  error-prone  task  of  compiling  the  mathematical 
model  as  system  of  equations  by  hand,  different  professional  software  packages  built  upon  this 
approach  are  commercially  available.  They  provide  the  engineer  not  only  with  software  tools  for 
ic  model  set  up  but  usually  also  allow  to  apply  a  wide  range  of  different  numerical  algorithms 
for  an  extensive  analysis  of  the  automatically  generated  system  equations  in  a  way  optimized 
on  the  specific  modelling  and  on  the  simulation  task.  As  indicated  in  figure  1,  the  simulation  of 
railway  vehicles  requires  the  simulation  software  to  provide  additionally  some  wheel-rail  specific 
functionalities  like  the  guidance  along  arbitrary  tracks  or  the  modelling  of  the  complicated 
interaction  between  wheel  and  rail.  An  overview  over  simulation  software  within  the  scope  of 
vehicle  dynamics  is  given  in  [4],  whereas  [2]  is  dedicated  to  wheel-rail  systems  only.  The  following 
software  specific  descriptions  are  based  on  the  simulation  package  Simpack  [71. 

Arhb^analyZmg  thC  dyimT  blehaviour  of  railway  veh*des  running  on  arbitrary  tracks  under 
arbitrary  manoeuvres  usually  the  vehicle  (and  the  maybe  necessary  environment)  is  abstracted 

the'cAE  ^milv'fcAE^  o' iton  ,wh  eventually  by  appropriate  software  tools  of 

the  CAE-family  (CAE  -  Computer  Aided  Engineering)  to  reproduce  specific  phenomena 
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Figure  1.  Algorithmic  software  elements  typically  applied  within  simulation  models  for  the  analysis  of  the 
running  behaviour  of  railway  vehicles  and  basing  on  an  MBS  approach  (Photograph:  C.  Splittgcrber,  Internet: 
http : / /mercur io .  iet . unipi .  it). 


Modelling  primary  (wheelset  -  bogie)  and  secondary  (bogie  -  car  body)  suspensions  of  railway 
vehicles,  the  complete  spectrum  of  linear  and  nonlinear  force  elements  might  come  into  operation. 
Typical  examples  of  force  elements  to  be  modelled  are  leaf  and  flexi-coil  springs,  air-springs  and 
damper  elements  with  rubber  bearings. 

Two  cars  usually  interact  via  buffers  and/or  a  draw-gear,  [6].  Buffers  sometimes  are  in  contact, 
sometimes  they  are  not;  if  they  are,  friction  between  spherical  surfaces  including  stick-slip  effects 
has  to  be  taken  into  account. 

An  interface  to  Finite-Element-software  (FEA)  allows  the  efficient  modelling  of  flexible 
bodies  within  the  MBS  -  a  modelling  task  becoming  more  and  more  important  with  regard 
to  the  growing  trend  to  lightweight  structures,  see  e.g.  [8].  With  respect  to  the  other  way  round, 
a  dynamic  stress  analysis  with  the  FEA-software  might  be  based  on  the  dynamic  forces  and 
accelerations  following  from  a  time-integration  of  the  system  equations,  [l]. 

More  and  more  actively  controlled  elements  like  actuators  or  tilting  technique  are  imple¬ 
mented  in  vehicles  to  increase  for  example  ride  comfort  or  safety.  To  incorporate  active/semi- 
active  elements  into  the  simulation  models  in  a  mechatronic  sense,  either  internal  controller 
design  tools  or  interfaces  to  CACE-software  like  MATLAB-Simulink  can  be  applied,  [9]. 

To  integrate  physical  and  graphical  CAD-data,  and  thus  extending  the  graphical  abilities 
of  simulation  and  concurrently  making  MBS-setup  very  much  easier,  faster  and  more  secure, 
an  interface  to  CAD-software  exists.  Vice  versa  MBS-simulation  might  be  used  to  support  the 
design  process  within  CAD-software  itself  by  dynamic  and  kinematic  analysis. 

One  characteristic  feature  of  railway  vehicles  is  the  guidance  of  the  vehicle  along  arbitrary 
tracks.  Additionally,  irregularities  from  those  ideal  tracks  have  to  be  considered  usually.  In  both 
cases,  the  modelling  possibilities  should  include  standard  models  to  be  defined  easily  as  well  as 
the  definition  of  realistic  tracks/perturbations  by  measured  data. 

A  vehicle  crossing  a  switch  is  a  simulation  task,  where  the  usual  assumption  of  a  non-varying 
profile  of  the  rail’s  cross-sections  is  not  sufficient  to  reproduce  motions  and  most  notably  the 
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interacting  forces  in  the  wheel-rail  interface  satisfactorily.  Hence  it  should  be  possible  to  define 
rail  profiles  varying  along  the  track,  [5],  Figure  2  presents  the  geometry  of  a  typical  switch  by 

“„danor  “tions  of  the  rails  in  the  vicinity  of  the  crossing  vee  (i>' and 


3.  Modelling  the  Wheel-Rail  Interface 

The  distinctive  feature  of  railway  vehicles  and  their  simulation  is  the  contact  between  steel 
wheel  and  steel  rail.  For  modelling  vehicles  with  the  traditional  wheelset  and  vehicles  with 
singly  suspended  wheels,  a  general  wheel-rail  contact  module  describing  basically  the  contact 
etween  one  wheel  and  the  rail  is  a  prerequisite.  In  the  sequel,  a  wheel-rail  functionality  based 
on  this  idea  will  be  pointed  out;  a  more  detailed  description  is  given  in  [5]  and  [7]. 

3.1.  System  equations 

Interpreting  the  interaction  between  wheel  and  rail  aa  rigid,  i.e.  as  kinematic  constraint  the 
and  t  Wef  T  °4fthC,  whcf  :ral1  system  could  be  formulated  in  the  position  coordinates  p  (t) 

ubcJic TdAE)  *  S<!  CqUati°nS  °f  th"  flrSt  ki"d'  yiCldh‘E  3 

P  =  v  (1) 

M(p,t)v  =  f(p,v,A,t)  — GT(p,f)A  (2) 

°  =  6(P.O-  (3) 

Herein,  the  algebraic  constraints  (3)  describing  the  contact  conditions  are  coupled  to  the  dy- 
namic  equations  (2)  by  the  Lagrangian  multipliers  A (t).  The  constraint  forces  -GT(p,  t)  A  with 
ffivX  P  •  Suarantee  the  kinematic  constraints  to  be  always  fulfilled.  The  force  vector 
J(P; v’  A  t)  comprises  all  applied  forces  (including  coriolis  forces  etc.),  thus  encompassing  the 
fact, on  forces  between  wheel  and  rail  which  depend  directly  on  the  constraint  forS  Uoo 
The  symmetric  mass  matrix  is  denoted  M(p).  { 

3.2.  The  quasi-elastic  contact  model 

Due  to  rotational  symmetry,  the  position  of  a  wheel  as  a  rigid  body  with  respect  to  the  rail 
might  be  described  uniquely  by  the  five  coordinates  q(p,t)  =  (x  y  z  w  ib)T  see  fifnire  3  lpff 
Introducing  the  distance  function  d(s,  q),  that 

on  the  wheel's  and  the  rad's  profile  cross  sections  in  the  normal  z-direction  the  geometry 
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Figure  3.  Left :  Relative  coordinates  of  a  wheel  with  respect  to  the  rail.  Right:  Lateral  location  s  of  the  point  of 
contact  on  the  wheel  in  dependency  of  the  relative  lateral  shift  between  wheel  and  rail  (profiles:  UIC60/S1002). 


problem  can  be  reduced  to  a  one-dimensional  one.  This  leads  to  the  classical  contact  condition 

#(q)  =  max  d(s,  q)  =  0.  (4) 

Since  the  relative  position  vector  q  as  well  as  the  contact  coordinate  s  depends  on  the  MBS 
coordinates  p,  this  contact  condition  defines  the  kinematic  constraint  in  equation  (3).  Thus,  the 
point  of  contact  follows  from  the  necessary  condition  dd(s,  q )/ds  =  0. 

The  crucial  point  for  the  simulation  of  wheel-rail  systems  is  the  differentiability  of  equa¬ 
tion  (4).  For  so-called  ‘wear  profiles1’  the  location  of  the  contact  point  is  discontinuous  with 
respect  to  q,  see  figure  3.  Hence,  the  usual  smoothness  assumptions  of  the  integration  algorithm 
are  violated  by  this  constraint.  To  overcome  this  difficulty,  a  new  numerical  analysis  was  devel¬ 
oped  in  [5].  Here,  the  elastic  deformation  of  the  wheel-rail  interface  is  taken  into  account  on 
the  whole  contact  patch  qualitatively.  Such  a  quasi-elastic  contact  model  avoids  unrealistic  step 
changes  of  the  contact  point  location  which  are  known  from  classical  rigid  contact  models. 

The  contact  condition  (4)  is  replaced  by 


Qix  5  in  ax  \ 

exp(-  d(s,  q))  ds  /  J  ds  j  =  0, 

■®min  / 


with  a  small  positive  parameter  e.  With  the  weighting  function  w(s,  q)  :=  exp(d(s,q)/e)  the 
straightforward  generalization  of  defining  the  contact  point  where  the  contact  forces  act,  leads 
then  to  the  formula  of  the  weighted  mean  value  of  the  contact  coordinate  s, 


5  max  3  max 

=  J  s  ■  tu(s,q)  ds  /  J  w(s,q)ds 


The  success  of  this  quasi-elastic  contact  model  is  verified  on  the  right  hand  side  of  figure  3, 
showing  the  smoothed  wheel  contact  coordinate  s  versus  the  relative  lateral  wheel-shift  y  in 
comparison  to  the  steep  gradients  in  the  vicinity  of  the  jumps  of  the  rigid  contact  model. 

Further,  the  computation  time  of  the  dynamic  simulation  might  be  reduced  drastically  by  the 
approximation  of  contact  parameters  with  three-dimensional  tensor-product  splines.  For  that 
purpose,  the  spline  coefficients  of  the  contact  point  location,  the  constraint  and  the  frictional 
parameters  are  computed  during  model  setup  in  a  pre-processing  step  and  stored  on  table  files. 
Then,  during  simulations,  only  these  tables  have  to  be  evaluated. 


Wear  profiles  represent  the  long  time  evaluation  of  the  shape  of  wheel  and  rail  surfaces  due  to  wear  caused 
by  the  process  of  rolling  contact. 
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wheel  profile  contact  patchl 


V  \ 


rrv 


iLT7ug<!r  Carn,,,,,i,,8  tl,ro,,«h  *l  switch.  Left:  Contact,  patches  between  left  wheel  and  rrn.ni,,,  rail  in 
vicinity  of  the  crossing  vee.  Right  Snap-shot  of  simulation  model  with  leading  bogie  entering  the  common 
crossing  and  the  inner  wheels  being  guided  by  the  check  rail  (large  -  back  view,  small  -  front  view). 

The  contact  forces  are  subdivided  into  normal  forces  and  tangential  friction  (slip)  forces  For¬ 
mulating  the  algebraic  constraint  condition  (3)  appropriately,  the  normal  force  follows  directly 
rom  .  e  generalized  constraint  forces  -G  A  of  the  equations  of  motion  (l)-(3)  The  calculation 
o  the  tangential  creep  forces  is  based  on  Hertzian  contact  properties  and  uially  * 

the  code  Fastsim  which  applies  Kalkers  simplified  theory  of  rolling  contact,  [3j. 

4.  Exemplary  Simulation  Task 

Multibody  simulation  has  gained  a  wide  field  of  application  not  only  within  research  but  also 
nn  in  us  ry.  s  ail  application,  the  simulation  of  a  passenger  car  running  through  a  switch 
as  been  chosen,  following  [5,  6],  In  the  lecture,  simulations  of  a  bogie  with  tilting  technique 
and  an  active  suspension  system  will  be  described  additionally. 

The  simulation  of  a  railway  vehicle  running  through  a  switch  as  shown  in  figure  4  requires 
a  couple  of  rather  unusual  features.  Firstly,  the  profile  cross  sections  of  the  rails  vary  along  the 
rack,  see  figure  2.  Secondly,  multiple  points  of  contact  have  to  be  expected,  primarily  then 

Thirdl  H  P°m‘ ?"thc  !eft  whecl  chanScs  the  wing  rail  to  the  crossing  vee,  see  figure  4 
rdly  during  this  transition,  the  whecl  may  lift-off  from  the  rail,  a  structural  change  handled 

by  switching  from  the  rigid  to  an  elastic  contact  model.  Throughout  this  situation,  the  whcelsct 

1  Xv  by,thC  COntaC,t  °f  fchc  back  0f  thc  right  wheel  with  thc  chcck  rail;  hence,  fourthly 
an  additional  contact  clement  between  the  back  of  wheels  and  check/wing  rails  is  necessary 
Exemplary  simulation  results  are  presented  in  figure  5.  y 


5.  Conclusions 

A  generally  applicable  simulation  tool  was  presented  with  the  main  focus  on  the  analysis  and 
des,g„  of  arbitrary  wheel-rail  systems.  Due  to  the  described  whcel-raii  module' the  potential 
odelhng  range  comprises  the  classical  rigid  whcelset  and  singly  suspended  wheels  as  well 
Interfaces  to  established  CAD-,  FEA-  and  CACE-software  facilitate  to meet ^simulation  tlsks 
arising  from  the  growing  application  of  rather  new  design  principles  further  -  and  sometimes 
only  their  extensive  apphcation  allows  to  fulfil  them  at  all.  A  simulation  study  of  a  pass  our 
car  running  hrough  a  switch  as  a  highly  complicated  exemplary  application  demonstrated 
efficiency  and  applicability  of  the  MBS-software  as  well  as  of  the  incorporated  wheel-rail  module. 
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Wheelset  1:  Lateral  shift 


Figure  5.  Passenger  car  running  through  a  switch  with  velocity  v  =  60  km/h.  Results  of  simulation,  leading 
wheelset:  Lateral  shift  with  respect  to  track  centre  line  and  lateral  force  of  wheelset  towards  track. 


In  the  lecture,  as  second  example  the  design  of  a  modern  passenger  car  bogie  including  tilting 
technique  and  an  active  suspensions  system  will  be  described. 
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Abstract.  In  this  paper  it  is  shown  how  non-holonomic  constraints  can  ho  included  in  the  for¬ 
um  aDon  of  the  dynamic  equations  of  flexible  multibody  systems.  The  equations  are  given  in 
state  space  form  with  the  degrees  of  freedom,  their  derivatives  and  the  kinematic  coordinates 
“  state  variables,  which  circumvents  the  use  of  Lagrangian  multipliers.  With  these  independent 
state  variables  for  the  system  the  derivation  of  the  linearized  equations  of  motion  is  straightfor¬ 
ward.  The  incorporation  of  the  method  in  a  finite  element,  based  program  for  flexible  multibody 

sys  ems  is  discussed  The  method  is  illustrated  by  a  stability  analysis  of  the  nominal  steady 
morion  oi  a  swivel  wheel.  J 


1.  Introduction 


le  motion  of  mechanical  systems  having  rolling  contact,  as  occur  in  road  vehicles  and  track- 
guided  vehicles,  can  be  investigated  in  an  approximate  way  by  a  mechanical  model  having 
non-holonomic  constraints.  These  constraints  express  the  conditions  of  vanishing  slips  at  the 
contact  points.  Whereas  the  dynamics  of  mechanical  systems  with  ideal  holonomic  constraints 
was  almost  completed  by  the  publication  of  Lagrange’s  monumental  Mechanise  anaUlrgne  fll, 
Hertz  [2]  was  the  first  to  describe  and  name  systems  with  non-holonomic  constraints.  Although 

' 10  PTClpf  !L C mi"imal  actl0n  fails  for  these  systems,  the  principle  of  virtual  power  and  the 
principle  of  D  Alembert  can  be  applied.  In  their  excellent  book  [3]  Nehnark  and  Fufaev  treat,  the 
kinematics  and  dynamics  of  non-holonomic  mechanical  systems  in  great  detail.  They  illustrate 
Hm  presented  theory  with  worked-out  examples  and  give  an  elaborate  reference  list  with  513 

The  study  of  small  vibrations  and  stability  of  conservative  non-holonomic  systems  near  equi¬ 
librium  states  has  lead  to  some  controversy  in  the  past.  Whittaker  in  his  Analytical  Dynam- 

hoW  °nt  C°n  Rd  that  f°r  SUCh  CaS0S  “the  difference  between  holonomic  and  non- 
holonomic  systems  is  unimportant”  and  that  the  vibration  motion  of  a  given  non-holonomic 
system  with  n  independent  coordinates  and  m  non-holonomic  constraints  is  the  same  as  that  of 
.  '.or tain  holonomic  system  with  n-m  degrees  of  freedom.  Bottema  [5]  showed  that  this  was 
incorrect,  and  pointed  out  that  the  characteristic  determinant  of  such  a  non-holonomic  system 

rontsT H  t  ^  COr.rORpondinS  characteristic  equation  possesses  as  many  vanishing 

roots  as  there  are  non-holonomic  constraints.  However,  besides  a  manifold  of  equilibrium  states^ 
some  non-holonomic  systems  also  possess  a  manifold  of  steady  motion.  Due  to  those  motions 
some  vanishing  roots  may  get  non-zero  values. 
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In  this  paper  we  pesent  a  procedure  for  including  non-holonomic  constraints  in  the  formu¬ 
lation  of  the  dynamical  equations  of  flexible  multibody  systems.  These  equations  are  given  for 
a  set  of  minimal  coordinates  rather  than  with  the  aid  of  Lagrangian  multipliers.  The  configura¬ 
tion  is  described  by  the  degrees  of  freedom  and  the  generalized  kinematic  coordinates,  as  many 
as  there  are  non-holonomic  constraints.  The  velocities  of  the  system  are  described  by  the  time 
derivatives  of  the  degrees  of  freedom.  The  dynamical  equations  in  a  state  space  form  comprise 
the  equations  of  motion  and  the  kinematic  differential  equations,  which  give  the  time  derivatives 
of  the  configuration  coordinates. 

The  derivation  of  the  linearized  equations  from  the  dynamical  equations  is  rather  straight¬ 
forward.  The  linearized  equations  can  be  used  to  analyse,  among  other  things,  the  stability  of  a 
nominal  steady  motion,  as  will  be  shown  in  an  example. 

2.  Dynamics  of  Non-Holonomic  Flexible  Multibody  Systems 

2.1.  FINITE  ELEMENT  MODELLING 

Multibody  systems  with  deformable  bodies  may  well  be  modelled  by  finite  elements.  The  distin¬ 
guishing  point  in  the  finite  element  approach  as  it  has  been  developed  in  Delft  and  implemented 
in  the  program  SPACAR.  [6]  is  the  specification  of  independent  deformation  modes  of  the  finite 
elements,  the  so-called  generalized  deformations  or  generalized  strains.  These  are  the  algebraic, 
analogue  to  the  continuous  field  description  of  deformations.  Rigid  body  motions  are  displace¬ 
ments  for  which  the  generalized  strains  are  zero.  If  the  specification  of  the  generalized  strains 
remains  valid  for  arbitrary  large  translations  and  rotations,  rigid  multibody  systems  such  as 
mechanisms  and  machines  can  be  analysed  by  setting  all  generalized  strains  to  zero.  These 
strain  equations  are  now  the  constraint  equations  which  express  rigidity.  Deformable  bodies  are 
handled  by  allowing  non-zero  strains  and  specifying  constitutive  equations  for  the  generalized 
stresses,  which  are  the  duals  of  the  generalized  strains. 

Instead  of  imposing  constraint  equations  for  the  interconnection  of  bodies,  which  is  a  wide¬ 
spread  approach  in  multibody  system  dynamics  formalisms,  permanent  contact  of  elements  is 
achieved  by  letting  them  have  nodal  points  in  common.  With  the  help  of  a  rather  limited  number 
of  element  types  it  is  possible  to  model  a  wide  class  of  systems.  Typical  types  of  elements  are 
beam,  truss  and  hinge  elements,  while  more  specialized  elements  can  be  used  to  model  joint 
connections  and  transmissions  of  motion. 

2.2.  HOLONOMIC  AND  NON-HOLONOMIC  CONSTRAINTS 

In  a  finite  element  description  of  a  multibody  system  the  configuration  is  described  by  a  number 
of  nodal  points  with  coordinates  x  and  a  number  of  elements  with  generalized  deformations 
or  generalized  strains  e.  The  nodal  coordinates  can  be  absolute  coordinates  of  the  position  or 
parameters  that  describe  the  orientation  of  the  nodes,  such  as  Euler  parameters.  The  generalized 
deformations  depend  on  the  nodal  coordinates  and  can  be  expressed  as 

£  =  D(x).  (1) 

Usually  holonomic  constraints  are  imposed  on  some  generalized  deformations  and  nodal  co¬ 
ordinates.  For  instance,  the  conditions  for  rigidity  of  element  e  are  ee  =  De(xe)  =  0.  If  the 
holonomic  constraints  are  consistent,  the  coordinates  can  locally  be  expressed  as  functions  of 
the  generalized  coordinates  q  by  means  of  a  transfer  function  F  as 

x  =  F(q,  t).  (2) 

The  prescribed  motions,  or  rheonomic  constraints,  which  are  known  explicit  functions  of  time, 
are  represented  here  by  the  time  t.  The  generalized  coordinates  can  be  chosen  from  components  of 
the  nodal  coordinate  vector  x  and  the  generalized  deformation  vector  e.  Generally  the  transfer 
function  cannot  be  calculated  explicitly,  but  has  to  be  determined  by  solving  the  constraint 
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equations  numerically  in  an  iterative  way.  Partial  derivatives  are  calculated  by  means  of  implicit 
differentiation. 

The  non-holonomic  constraints,  as  may  arise  from  elements  having  idealized  rolling  contact, 
can  be  expressed  in  terms  of  slips  that  are  zero  [9].  Such  a  slip  is  usually  defined  as  some 
relative  velocity  between  the  two  bodies  in  the  contact  area,  and  is  therefore  linear  in  the 
velocities'.  Fm  instance,  if  element  e  has  non-slipping  contacts,  it  has  to  satisfy  the  constraints 

s  -  V  (x  )x  -  0.  Assembly  of  all  conditions  of  zero  slip  for  the  system  results  in  the  non- 
holonomic  constraints 

s  =  V(x)x  =  0.  (3) 

Owing  to  these  constraints,  the  generalized  velocities  q  are  now  dependent.  This  dependency 
is  expressed  by  a  splitting  of  the  generalized  coordinates  q  into  the  degrees  of  freedom  qd  and 
the  generalized  kinematic  coordinates  q*.  The  velocities  of  the  system  can  now  be  expressed  in 
terms  of  the  first-order  transfer  function  H  times  the  velocities  of  the  degrees  of  freedom  and  a 
term  representing  the  prescribed  motion,  as  in 

x  =  H(q,f)q'i  + v(q,t).  (4) 

The  expressions  for  the  first-order  transfer  function  and  the  prescribed  motion  terms  are  found 
by  differentation  of  (2)  and  splitting  of  terms  as  in 

x  =  F,q,iq"  +  F,q,q*  +  F„  (5) 

where  partial  derivatives  are  denoted  by  a  subscript  comma  followed  by  the  variable.  Substitution 
in  the  non-holonomic  constraints  (3)  results  in 

V[F>q,qrf  +  F(q,qfe  +  F,,]  =  0.  (G) 

From  these  equations,  as  many  as  there  are  kinematic  coordinates  qk,  the  velocities  qk  can  be 
solved  as 

qk:  =  -(VFiq,)-'  [VF>q„qrf  +  VF,t].  (7) 

Substitution  of  this  result  in  (5)  and  comparing  terms  with  (4)  results  in  the  first-order  transfer 
function 

H  =  [I-F,q,(VF)q0-’V]F)q,,  (8) 

and  the  velocities  v,  representing  the  prescribed  motion,  as 

v  =  [I  -  F  q*(VF>q*)-1  V]Fif.  (9) 

In  both  expressions  we  identify  the  use  of  the  inverse  of  the  Jacobian  of  the  non-holonomic 

constraints  with  respect  to  the  generalized  kinematic  coordinates 

VFV-  (10) 

If  this  Jacobian  is  singular,  we  have  to  choose  another  set  of  generalized  kinematic  coordinates 
and  consequently  another  set  of  degrees  of  freedom  to  describe  the  system  uniquely.  Having 
taken  into  account  all  constraints  we  can  define  the  state  of  the  system  at  a  time  t,  as 

(q'WW).  (11) 

Next  we  will  derive  the  dynamical  equations  of  the  system,  or,  in  other  words,  the  time  derivative 
of  the  state  of  the  system. 


2.3.  EQUATIONS  OF  MOTION 

The  derivative  of  the  first  part  of  the  state  vector,  qrf,  with  respect  to  time  follows  from  the 
equations  of  motion  of  the  system.  The  equations  of  motion  for  the  constraint  multibody  system 
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will  be  derived  from  the  principle  of  virtual  power  and  the  principle  of  D’Alembert.  This  method 
can  be  traced  back  to  Lagrange  who  by  his  monumental  Mechanique  analitique  [1]  became  the 
founder  of  the  study  of  motion  of  systems  of  bodies.  The  inclusion  of  non-holonomic  constraints 
was  not  foreseen  by  Lagrange.  Hertz  [2]  was  the  first  to  describe  and  this  type  of  constraints. 

First  for  each  node  and  element  in  the  system,  we  determine  a  mass  matrix  MR  and  a  force 
vector  fe,  which  give  a  contribution  to  the  virtual  power  of 

<?xeT(fe  -  Mexe)  (12) 

The  virtual  power  equation  of  the  system  is  obtained  by  assembling  the  contribution  of  all 
elements  and  nodes  in  a  global  mass  matrix  M  and  a  global  force  vector  f ,  which  results  in 

<5xr[f(x,x,  t)  -  M(x)x]  =  0.  (13) 

Here,  6±  are  kinematically  admissible  virtual  velocities,  which  satisfy  all  instantaneous  kinematic 
constraints.  They  follow  directly  from  (4)  as 

<5x  =  H6qd.  (14) 

The  coordinate  accelerations  are  obtained  by  differentation  of  the  velocities  (4),  resulting  in 

x  =  H(q,f)qrf  +  g(q,q,i;),  (15) 

where  we  have  collected  all  convective  and  prescribed  accelerations  in  the  g  terms.  These  accel¬ 
erations,  which  depend  only  on  the  state  of  the  system,  are  given  by 

g  =  H  qqdq  +  H  tqrf -f  v>qq  +  v(<.  (16) 

Substitution  of  the  acceleration  (15)  in  the  virtual  power  equation  (13)  yields  the  reduced  equa¬ 
tions  of  motion 

M(qrf,qfc,t)q'/=f(qrf,qrf,qfc,<),  (17) 

with  the  reduced  global  mass  matrix, 

M  =  HtMH,  (18) 

and  the  reduced  global  force  vector, 

f  =  HT[f  -  Mg].  (19) 

The  time  derivative  of  the  second  part  of  the  state  vector,  qd,  is  obviously  the  first  part  of  the 
state  vector  itself.  The  time  derivative  of  the  generalized  kinematic  coordinates,  qfc,  as  found  in 
(7),  can  in  general  be  expressed  as 

qfc  =  A(q,t)qrf-|-b(q,f),  (20) 

where  the  matrix  A  and  the  velocity  vector  b,  which  represents  the  velocities  of  the  rheonomic 
constraints,  are  given  by 

A  =  —  (VFqfc)-1VFqri,  and  b  =  -(VF^)"1 VF>t.  (21) 

Note  in  both  expressions  the  presence  of  the  inverse  of  the  Jacobian  (10). 

We  summarize  by  writing  down  the  time  derivative  of  the  state  vector  or  the  state  equations 
as 


qd 

'  M-’f  ' 

qd 

qd 

qfc 

.  Aqd  +  b  . 
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(22) 


2.4.  LINEARIZED  EQUATIONS  OP  MOTION 

To  describe  the  small  vibrations  or  motions  with  respect  to  a  nominal  steady  motion  we  have  to 
linear™  the  dynamical  equations  (22).  For  the  description  of  the  small  motions  we  will  use  the 
dynamic  degrees  of  freedom  The  linearisation  is  done  in  the  nominal  reference  state  which  is 
refer  "T  *7  'q  ,q  >  “  (°>°i1o).  ",|“'ro  q S  stands  for  the  kinematic  coor . at.es  in  the 

of  motionin');  ms’lZ;  "  ’***  <22>'  “» 


MAqrf  +  CAqd  +  KrfAqfi  +  KkAqk  =  -fd, 


where  the  prefix  A  denotes  a  small  increment,  M  is  the  reduced  mass  matrix  as  in  (18)  C 

Iff  Lfr'f'V'‘y,  mi“rix  Whidl  “-I*  •—  resulting  from  damping  and  gyroscopic 

•fFects,  K  and  K  are  the  total  stiffness  matrices.  The  forcing,  -frf,  on  right-hand  side  of  flic 
equations  results  from  the  nominal  steady  motion  solution.  In  order  to  maintain  the  prescribed 
values  for  lie  dynamic  degrees  of  freedom  and  the  kinematic  coordinates  during  t.hLs  motion 

of  S  ?Th t0  b,°  ,nt,rOrduC0d  in  th0  riRht-hand  «ide  of  the  reduced  equations 

0  motion  (17).  The  sum  of  the  reduced  forces  has  to  be  zero,  as  in 

Hr[f  -  Mg]  +  ff/  =  0,  (24) 

from  which  the  forces  fd  are  found. 

The  matrices  of  the  linearized  equations  are  determined  in  the  following  way.  First  for  all 

dements  and  nodes  the  contribution  to  the  global  stiffness  matrix  K  and  the  global  velocity 
matrix  C  are  determined  as  b 

CP  =  -(H,**  and  Kr  —  (MRxc  -  f°)xn.  (25) 

These  global  matrices  having  been  determined,  the  matrices  in  the  linearized  equations  are  given 
C  =  KrCH  +  HrMgcVf, 

K  =  [Kd  Kk)  =  HrKFiq  +  HJtMx  -  f ]  +  H^[Mg,q  +  Cv,q].  (26) 

Note  that  all  matrices  are  generally  a  function  of  time  due  to  the  non-linear  steady  motion 
Linearization  of  the  second  part  of  equation  (22)  is  trivial.  The  last  part,  the  linearization  of 
the  rate  of  the  generalized  kinematic  coordinates  is  derived  from  (20)  as 

Aq*  =  A(q,i)Aqrf  +  Bd(q,f)Aq"  +  Bk(q,t)Aqk.  (27) 

The  B-matriccs  express  the  sensitivity  of  the  generalized  kinematic  velocities  with  respect  to 
the  generalized  coordinates,  and  are  given  by  1 

B  (q,  t)  =  b  qrf  and  Bfc(q,  /,)  =  b  qk  (2g) 

We  conclude  by  summarizing  the  linearization  of  the  state  equations  in  matrix  vector  form 


M  o  0  1  r  Aqrf  1  r  c  K(l  Kk  ]  f  Aqd  1  f  ~\ 

0  10  Aqd  +  -I  o  o  Aqrf  =  0  (2Q) 

L  0  0  I  J  Aqfc  J  L  -A  -Bd  — Bfc  J  [  Aqfc  j  0  J 

The  stability  of  a  system  in  steady  motion  can  be  investigated  by  the  homogeneous  linearized 
state  equation  from  (29)  Under  the  usual  assumption  of  an  exponential  motion  with  respect 

o  time  for  the  small  variations  (Aqd,  Aqd,  Aq*f  we  end  up  with  a  characteristic  equaUon  fo 

the  unknown  exponents.  The  stability  of  an  equilibrium  state,  the  case  of  zere  slady  motion 
as  investigated  by  Bottema  [5],  corresponds  to  vanishing  B-matrices  and  consequently  results 
...  vanishing  routs,  as  many  as  there  are  kinematic  coordinates  or  non-holonZfc  Zswl 
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3.  Example:  Swivel  Wheel  Shimmy 

To  illustrate  the  general  method  for  the  derivation  of  the  state  equations  of  a  non-holonomic 
system  and  their  linearization  we  shall  revisit  the  shimmy  problem  of  an  aircraft  landing  gear  as 
treated  by  Den  Hartog  [7].  He  simplified  the  problem  in  order  to  show  the  principal  mechanism 
responsible  for  the  shimmy  phenomenon.  The  mass  and  stiffness  of  the  airplane  are  assumed 
large  with  respect  to  those  of  the  swivel  landing  wheel,  so  that  the  attachment  point  of  the  swivel 
axis  to  the  airplane  may  be  assumed  to  move  forward  at  a  constant  speed.  The  tire  is  assumed  to 
be  rigid  and  the  inertia  along  the  axis  of  rotation  of  the  wheel  is  not  taken  into  account.  Then 


Figure.  1.  Swivel  wheel 


in  Figure  1,  which  is  a  plan  view  of  the  shimmying  wheel  seen  from  above,  point  C  is  the  point 
where  the  wheel  strut  is  built  into  the  airplane.  Point  B  is  the  bottom  point  of  the  strut;  normally 
B  is  right  under  C,  but  while  shimmying  the  strut  is  assumed  to  flex  sideways  through  distance  u 
at  a  stiffness  k.  The  wheel  is  behind  B  with  angle  </>,  the  shimmy  angle,  which  is  zero  for  normal 
ideal  operation.  A  is  the  centre  of  the  wheel,  and  G  is  the  centre  of  gravity  of  the  combined 
landing  gear.  The  finite  element  model  consists  of  a  wheel  element  [9]  attached  in  point  A  to  a 
rigid  beam.  The  wheel  has  zero  lateral  slip  which  is  the  non-holonomic  condition  in  the  system. 
The  beam  is  connected  in  point  B  to  a  cylindrical  bearing  element.  The  bearing  is  rigid  in  the 
longitudinal  and  flexible  in  the  lateral  and  rotational  direction  and  the  generalized  deformations 
are  denoted  by  u  and  <j).  The  lateral  stiffness  is  k  while  the  rotational  stiffness  is  assumed  to 
be  zero.  The  bearing  is  moved  forward  with  a  constant  speed  of  v.  The  generalized  coordinates 
of  the  system  are  given  by  q  =  (u,<p).  The  zero  lateral  slip  condition  on  the  wheel  reduces  the 
coordinates  to  the  degree  of  freedom  qrf  =  (»)  and  the  kinematic  coordinate  =  {(f>).  The  steady 
state  undeformed  motion  is  characterized  by  (?'/,,  u,  <f))  =  (0,0,0).  With  the  variations  Aqd  =  An, 
Aqd  =  A?/,  and  Aq*  =  A</y  the  coefficients  of  the  linearized  state  derivatives  according  to  (29) 
are 


M 

_  ^.,a2  +  r\ 
m(  p,  )i 

_ 

,ab  —  r2 

C 

=  P  >?• 
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Kd 

=  k, 
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K* 

ab  —  r2  w2 

-  ”>(  P  V 

Bfc  = 

f 
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V 

0, 

v 
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(30) 


These  coefficients  are  usually  numerically  calculated  by  the  program  but  we  present  them  here 
in  an  analytical  form  so  we  can  compare  them  with  the  approach  as  presented  by  Den  Hartog  [7], 
His  ad  hoc  analysis  leads  to  an  eigenvalue  problem.  The  systematically  derived  linearized  state 
derivatives  (30)  lead  to  the  same  eigenvalue  problem  and  consequently  to  the  same  prediction 
of  unstable  shimmy  behaviour. 

To  investigate  the  shimmy  motion  we  start  with  the  usual  assumption  of  an  exponential 
motion  for  the  small  variations  Aq  of  the  form  Aq0exp(A/,).  The  characteristic  equation  of  the 
eigenvalue  problem  from  (29)  with  the  coefficients  from  (30)  is 

A3  +  (1  -f  /v,)wA2  +  ca2  A  +  caw2  =  0,  (31) 
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with  the  mass  distribution  factor  ,i  =  jab  -  r2)/(g2  +  r2),  the  driving  frequency  w  =  v/l.  and  the 
natural  frequency  un  -  sjki1 /{m{ak  +  r2)).  A  neccessary  and  sufficient  condition  for  asymptotic 
stab'hty.s  given  by  the  requirement  that  all  roots  of  (31)  have  negative  real  parts.  Application 
of  Hurwitz’s  theorem  on  the  characteristic  equation  (31)  yields 

u>  >  0  and  //.  >  0.  (32) 

In  other  words,  the  motion  is  stable  if  the  driving  speed  v  is  positive  and  the  centre  of  mass 
is  positioned  such  that  a(l  -  a)  >  r2.  The  latter  corresponds  to  a  region  of  ±J(l/2)2  -  r 2 
around  the  midpoint  a  =  1/2.  For  the  critical  case,  where  o.(l  -  a )  =  r2,  there  is  one  real 
eigenvalue  A,  =  -w  describing  the  non-oscillating  decaying  motion  and  a  pair  of  conjugated 
imaginary  values  A2,3  =  ±u>ni  which  describe  the  undamped  oscillatory  solution.  This  critical 
case  corresponds  to  a  mass  distribution  where  point  B  is  the  centre  of  percussion  or  in  other 
words,  the  lateral  contact  force  in  A  has  no  influence  on  the  lateral  spring  force  in  B. 


Im(\)/w0 
1.5  I - 


all 

( 

? - 

" - — 

lm(X)k o0 
1.5  I - T 


0  0.5 

Re(\)k  o 


0  0.2  0.4  0.6  0.8  1.0 

all 


Eigenmode  for  all= 0.3,  a=0±M0i. 


-1.5  -1.0 


0  0.5 

Re(\)h» 


Figure.  2.  Root  loci  of  the  eigenvalues  A  for  the  swivel  wheel  with  moment  of  inertia  /  =  0.2hnl2  in  the  centre 
of  mass  position  range  of  0  <  a/l  <  1  and  eigenmode  for  the  undamped  oscillatory  case  a/l  =  0.3,  with  driving 
frequency  ui  =  v/l  and  undamped  eigenfrequency  un  —  ^/fc/(0.3m). 

T12  6eneral  S°lution  for  the  eiSenvalues  can  be  found  by  solving  the  characteristic  equation 
(31).  However,  the  general  solution  of  a  cubic  equation  leads  to  lengthy  expressions  and  give 
little  insight,  in  the  nature  of  the  solution.  To  illustrate  the  behaviour  of  the  system  at  the  non- 
critical  cases,  consider  a  swivel  wheel  with  mass  moment  of  inertia  I  =  0.21  ml?.  The  motion  is 
stable  if  the  centre  of  mass  position  a  is  between  0.3/  and  0.7/.  The  root  loci  for  this  example 
in  range  of  0  <  a/l  <  1  are  shown  in  Figure  2  together  with  the  eigenmode  for  the  undamped 
oscillatory  case  a/l  =  0.3.  The  lateral  displacement  of  the  attachment  point  B,  u,  and  the  lateral 
displacement  of  the  centre  of  the  wheel  A,  denoted  by  w,  are  illustrated  in  the  figure  by  the 
vertical  projection  of  the  rotating  arrows.  Note  that  the  lateral  displacements  arc  not  in  phase. 

e  p  ase  angle,  tp,  and  the  amplitude  ratio,  Awo/Auq,  are  for  given  eigenvalue  A  =  70  +  uni 
uniquely  determined  by  the  kinematic  rate  equation  (27)  and  read 


tan  ip  =  — 


w  +  7o 


(w  +  To)2  +  Wn 
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The  wheel  centre  and  the  attachment  point  are  always  out  of  phase,  even  in  the  undamped 
oscillatory  case  where  70  =  0. 

4.  Conclusion 

A  procedure  has  been  described  for  formulating  the  dynamical  equations  of  non-holonomic  me¬ 
chanical  systems  as  well  as  their  linearized  equations.  The  procedure  can  be  applied  to  systems 
with  flexible  bodies  with  the  same  ease  as  to  systems  with  rigid  bodies.  Advantages  of  the 
procedure  are  the  use  of  a  set  of  minimal  independent  state  variables,  which  avoid  the  use 
of  differential-algebraic  equations,  and  the  analytic  linearization,  which  is  more  accurate  than 
numerical  differentiation.  The  linearized  equations  can  be  used  to  analyse  small  vibrations  su¬ 
perimposed  on  a  rigid  body  motion,  as  is  described  in  [8]  for  holonomic  systems. 

It  is  planned  to  apply  the  procedure  for  more  general  forms  of  rolling  contact  than  a  sharp 
edged  disk  on  a  surface  [9],  for  instance  the  contact  as  occurs  between  wheels  and  rails  in  railway 
vehicles. 
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ABSTRACT  For  efficient  dynamic  simulation  of  mechanical  and  aerospace  systems,  the  use  of 
different  sets  of  coordinate  types  may  be  necessary.  The  components  of  multibody  systems  can 
be  rigid,  flexible  or  very  flexible  and  can  be  subject  to  contact  forces.  Examples  of  challenging 
problems  encountered  when  multibody  systems  are  considered  are  crashworthiness,  problems  of 
cables  used  in  rescue  operations  and  heavy  load  handling,  leaf  spring  system  design,  tire 
deformations,  large  deformation  of  high-speed  rotors,  stability  problems,  and  contact  problems. 
Most  large  displacement  problems  in  structural  mechanics  are  being  solved  using  incremental 
solution  procedures.  On  the  other  hand,  general  purpose  flexible  multibody  computer  tools  and 
methodologies  in  existence  today  are  not,  in  general,  capable  of  systematically  and  efficiently 
solving  applications  that  include,  in  addition  to  rigid  bodies  and  bodies  that  undergo  small 
deformations,  bodies  that  experience  very  large  deformations.  The  objective  of  this  paper  is  to 
discuss  the  development  of  new  computational  algorithms,  based  on  non-incremental  solution 
procedures,  for  the  efficient  simulation  of  multibody  systems  with  flexible  components.  These 
new  algorithms  that  do  not  require  special  measures  to  satisfy  the  principles  of  work  and  energy 
and  lead  to  optimum  sparse  matrix  structure  can  be  used  as  the  basis  for  developing  a  new 
generation  of  flexible  multibody  computer  programs.  The  proposed  non-incremental  algorithms 
integrate  three  different  formulations  and  three  different  sets  of  generalized  coordinates  for 
modeling  rigid  bodies,  flexible  bodies  with  small  deformations,  and  very  flexible  bodies  that 
undergo  large  deformations.  The  implementation  of  a  general  contact  model  in  multibody 
algorithms  is  also  presented  as  an  example  of  mechanical  systems  with  non-generalized 
coordinates.  The  kinematic  equations  that  describe  the  contact  between  two  surfaces  of  two 
bodies  in  the  multibody  system  are  formulated  in  terms  of  the  system-generalized  coordinates 
and  the  non-generalized  surface  parameters.  Each  contact  surface  is  defined  using  two 
independent  parameters  that  completely  determine  the  tangent  and  normal  vectors  at  an  arbitrary 
point  on  the  body  surface.  In  the  contact  model  presented  in  this  study,  the  points  of  contact  are 
determined  on  line  during  the  dynamic  simulation  by  solving  the  non-linear  differential  and 
algebraic  equations  of  the  constrained  multibody  system.  The  augmented  form  of  the  equations  of 
motion  expressed  in  terms  of  the  generalized  coordinates  and  non-generalized  surface  parameters 
is  presented  in  this  paper. 


1.  INTRODUCTION 

A  new  generation  of  flexible  multibody  tools  is  needed  for  the  analysis  of  modem,  high-speed, 
light-weight  multibody  system  applications.  Existing  multibody  simulation  tools  suffer  from 


228 


serious  limitations  and  are  not  suited  for  modeling  the  dynamic  phenomena  that  are  encountered 
in  the  analysis  of  modem  systems.  These  existing  tools  are  designed  to  solve  problems  of 
mutlibody  systems  that  consist  of  rigid  components  or  flexible  components  that  experience  small 
deformations.  Furthermore,  the  existing  algorithms  fail  to  produce  efficient  and  accurate 
solutions  for  some  basic  vehicle  elements,  such  as  leaf  springs,  and  flexible  cables  used  in  rescue 
operations  and  heavy  load  handling.  Most  existing  flexible  multibody  computational  algorithms, 
with  few  exceptions,  employ  two  different  dynamic  formulations.  The  first  formulation  is  based 
on  the  classical  Newton-Euler  or  Lagrangian  equations  for  rigid  bodies,  while  the  second 
formulation  is  based  on  the  floating  frame  of  reference  approach.  In  the  rigid  body  formulation, 
six  independent  coordinates  are  initially  used  to  describe  the  body  configuration.  These  six 
coordinates  include  three  translation  coordinates  that  define  the  location  of  the  origin  of  a 
centroidal  body  reference,  and  three  orientation  coordinates  that  define  the  orientation  of  the 
body  reference.  The  generalization  of  this  formulation  to  study  the  dynamics  of  flexible  bodies 
that  experience  small  deformations  required  introducing  an  additional  set  of  generalized 
coordinates  in  order  to  be  able  to  define  the  body  deformation  with  respect  to  its  reference.  In  the 
early  eighties,  this  generalization  led  to  the  development  of  a  new  generation  of  general-purpose 
flexible  multibody  computer  codes  that  are  currently  widely  used  in  industry  and  research 
laboratories.  Such  codes  have  been  used  as  the  basis  for  developing  new  computational  design 
and  analysis  approaches.  These  multibody  dynamics  codes  have  been  used  in  the  design  of  many 
mechanical  and  aerospace  system  applications,  and  have  resulted  in  tremendous  saving  of 
resources  that  would  have  been  otherwise  wasted.  Preliminary  designs  are  made  in  a  computer 
environment  before  building  the  actual  prototypes,  while  existing  designs  are  continuously 
improved  by  utilizing  the  first  generation  of  flexible  mqltibody  computer  codes. 

The  general  treatment  of  the  rigid  body  contact  problem  requires  the  use  of  a  set  of 
parameters  that  describe  the  geometry  of  the  contact  surfaces.  Two  parameters  are  introduced  for 
each  surface.  Using  the  four  surface  parameters  associated  with  each  contact,  five  algebraic 
contact  constraint  equations  are  formulated.  The  kinematic  contact  constraint  equations  are 
expressed  in  terms  of  the  generalized  coordinates  of  the  two  bodies  as  well  as  the  non-generalized 
surface  parameters.  In  order  to  be  able  to  satisfy  the  nonlinear  contact  constraint  conditions  at  the 
position,  velocity,  and  acceleration  levels,  third  partial  derivatives  of  these  constraint  equations 
with  respect  to  the  surface  parameters  must  be  evaluated. 


2.  GENERALIZED  COORDINATES 

The  first  step  in  developing  a  new  formulation,  is  to  select  the  system  coordinates.  While  in  most 
formulations,  one  coordinate  type  is  used,  in  this  study,  it  is  proposed  to  develop  a  new  non- 
incremental  methodology  that  utilizes  different  coordinate  types  in  order  to  achieve  efficiency 
and  generality  while  maintaining  accuracy.  Different  components  in  the  system,  depending  on 
whether  they  are  rigid,  flexible  or  very  flexible,  will  be  modeled  using  different  types  of 
coordinates.  That  is,  the  choice  of  coordinates  will  be  determined  by  the  degree  of  flexibility  of 
the  components  of  the  system.  Such  a  choice  of  coordinates  introduces  many  interesting 
fundamental  and  numerical  problems  that  include  the  coupling  between  the  coordinates  due  to  the 
joint  constraints;  the  definition  of  different  generalized  forces  associated  with  different  sets  of 
coordinates;  the  structure  of  the  equations  of  motion  in  terms  of  different  sets  of  coordinates;  and 
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the  scaling  and  numerical  problems  that  arise  as  the  result  of  using  different  coordinates  with 
different  magnitudes. 

The  new  generation  of  flexible  multibody  algorithms  must  incorporate  the  following 
different  sets  of  generalized  coordinates;  reference  coordinates ,  elastic  coordinates  for  small 
deformations,  and  absolute  nodal  coordinates  for  large  deformations.  In  this  study,  the  reference 
coordinates  are  used  to  define  the  location  and  orientation  of  a  selected  body  reference.  In  the 
case  of  rigid  bodies,  a  centroidal  body  coordinate  system  is  used.  In  the  three  dimensional 
analysis,  the  reference  coordinates  consist  of  three  translation  coordinates  and  three  or  four 
orientation  parameters  depending  on  whether  Euler  angles  or  Euler  parameters  are  used.  This  set 
of  coordinates  can  be  used  to  develop  efficient  models  for  bulky  components  that  can  be  treated 
as  rigid  bodies.  The  elastic  coordinates  used  for  the  small  deformation  problem  define  the  body 
deformation  with  respect  to  the  body  coordinate  system.  Such  a  choice  of  a  coordinate  set  allows 
using  deformation  modes  in  order  to  reduce  the  number  of  the  system  degrees  of  freedom.  By 
using  this  set  of  elastic  coordinates  and  the  floating  frame  of  reference  formulation,  an  efficient 
algorithm  for  solving  small  deformation  problems  in  multibody  systems  that  takes  into  account 
the  nonlinear  coupling  between  the  reference  motion  and  the  elastic  deformation  can  be 
developed.  This  formulation,  which  leads  to  a  nonlinear  mass  matrix  and  a  simple  expression  for 
the  elastic  forces,  can  be  effectively  and  efficiently  used  to  model  flexible  components  in  many 
multibody  system  applications.  In  the  floating  frame  of  reference  formulation,  the  global  position 
vector  of  an  arbitrary  point  on  a  body  i  in  the  system  can  be  written  as  follows: 

r'=R'+A'(u:+S'qy) 

where  R  is  the  global  position  vector  of  the  origin  of  the  body  coordinate  system,  A1  is  the 
transformation  matrix  that  defines  the  orientation  of  the  body  coordinate  system,  u'is  the 
position  vector  of  the  arbitrary  point  in  the  undeformed  state,  S;  is  the  shape  function  matrix,  and 
is  the  vector  of  elastic  coordinates  that  define  the  body  deformation  with  respect  to  the  body 
coordinate  system.  Note  that  the  preceding  equation  can  be  used  also  to  describe  the  rigid  body 
kinematics  by  setting  the  last  term  equal  to  zero.  In  this  special  case,  the  rigid  boy  kinematics  is 
described  using  the  reference  translation  coordinates  R1  and  the  orientation  coordinates  2‘  that 
define  the  transformation  matrix  A'. 

The  third  set  of  generalized  coordinates  used  to  describe  the  large  deformations  will  be 
introduced  using  the  absolute  nodal  coordinate  formulation.  This  set  of  generalized  coordinates 
consists  of  global  displacement  and  slope  coordinates  and  does  not  include  any  infinitesimal  or 
finite  rotations.  By  using  the  absolute  nodal  coordinates,  exact  modeling  of  the  rigid  body 
dynamics  can  be  obtained.  Furthermore,  the  absolute  nodal  coordinate  formulation  leads  to  a 
constant  mass  matrix  in  two-  and  three-dimensional  problems.  In  this  formulation,  the  global 
position  vector  of  an  arbitrary  point  on  the  flexible  body  is  defined  as 


where  S a  is  a  shape  function  matrix,  and  qa'  is  the  vector  of  absolute  coordinates  that  consist  of 
global  displacement  and  slope  coordinates.  It  can  be  shown  that  the  preceding  equation  can  be 
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used  to  describe  an  arbitrary  rigid  body  motion  and  can  also  be  effectively  and  efficiently  used  to 
describe  the  large  deformation  of  beams,  plates  and  shells. 

Using  the  different  sets  of  coordinates  above  described,  the  vector  of  the  generalized 
coordinates  of  the  multibody  system  that  contains  rigid,  flexible,  and  very  flexible  components 
can  be  described  using  the  following  set  of  system  generalized  coordinates: 


where  R  and  2  are  the  reference  coordinates  of  the  rigid  or  flexible  bodies  in  the  system,  q^  is  the 
vector  of  elastic  coordinates  that  define  the  small  deformations  of  the  bodies  with  respect  to  the 
body  coordinate  system,  and  qa  is  the  vector  of  absolute  nodal  coordinates  used  to  describe  the 
motion  of  bodies  in  the  system  that  undergo  large  deformations.  The  preceding  equation  can  be 
written  in  terms  of  three  distinct  sets  of  coordinates  as  follows: 

f  T  T  TlT 

q=L^  <1/  q*  J 

where  qr  =  [Rt  2t]t  is  the  vector  of  reference  coordinates  of  the  system. 

3.  NON-GENERALZED  COORDINATES 

The  general  treatment  of  the  rigid  body  contact  problem  requires  introducing  a  set  of  parameters  s 
that  describe  the  geometry  of  the  contact  surfaces.  In  the  augmented  form  of  the  equations  of 
motion,  there  is  no  inertia  or  generalized  forces  associated  with  these  parameters,  and  for  this 
reason,  they  are  referred  to  as  non-generalized  coordinates.  Using  these  surface  parameters,  the 
tangents  and  normal  to  a  surface  at  the  contact  point  can  be  determined,  and  used  to  define  the 
contact  conditions.  By  using  this  approach,  the  contact  points  can  be  determined  on  line,  and  the 
coupling  between  the  generalized  and  non-generalized  surface  parameters  can  be  taken  into 
consideration.  By  introducing  the  surface  parameters  for  the  rigid  body  contact,  the  vector  of  the 
system  coordinates  can  be  written  as  follows: 

p=|_qr  q/  q a  « J 

In  the  following  section,  the  formulation  of  the  constrained  dynamic  equations  of  motion 
in  terms  of  the  generalized  coordinates  and  non-generalized  surface  parameters  is  discussed. 

4.  DYNAMIC  EQUATIONS 

A  new  general  flexible  multibody  algorithm  must  allow  joint  connectivity  between  rigid  bodies, 
flexible  bodies,  and  very  flexible  bodies  as  well  as  the  general  treatment  of  the  contact  problem. 
In  this  case,  the  joint  constraints  must  be  expressed  in  terms  of  the  reference,  elastic  and  absolute 
nodal  coordinates.  Considering  also  driving  constraints  that  can  depend  explicitly  on  time,  the 
vector  of  nonlinear  constraint  functions  can  be  expressed  in  terms  of  the  system  reference,  elastic 
and  absolute  nodal  coordinates  as  well  as  the  non-generalized  surface  parameters  as  follows: 
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As  demonstrated  in  the  multibody  dynamics  literature,  the  floating  frame  of  reference 
formulation  leads  to  highly  nonlinear  expressions  for  the  joint  constraints  as  the  result  of  using 
the  body  coordinate  system  that  introduces  geometric  nonlinearities.  The  formulation  of  many  of 
these  joints,  however,  becomes  much  simpler  when  the  absolute  nodal  coordinate  formulation  is 
used.  Nonetheless,  since  slopes  are  used  as  coordinates  in  the  absolute  nodal  coordinate 
formulation,  the  formulations  of  some  joints  require  the  development  of  new  special  techniques 
for  defining  the  kinematics  of  selected  reference  frames  at  the  joint  definition  points  in  terms  of 
the  absolute  nodal  coordinates. 

The  kinematic  constraints  that  describe  mechanical  joints,  contact  conditions  and 
specified  motion  trajectories  can  be  adjoined  to  the  system  differential  equations  of  motion  using 
the  technique  of  Lagrange  multipliers.  This  leads  to  the  following  augmented  form  of  the  system 
equations  of  motion: 
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where  M  refers  to  a  mass  sub-matrix,  subscripts  r,  f,  a ,  and  s  refer  respectively  to  reference, 
elastic,  absolute  nodal  coordinates,  and  non-generalized  surface  parameters,  Cq  is  the  constraint 
Jacobian  matrix  associated  with  the  generalized  coordinates,  Cs  is  the  constraint  Jacobian  matrix 
associated  with  the  non-generalized  surface  parameters  s,  8  is  the  vector  of  Lagrange  multipliers, 
Qr,  Q f,  and  Qa  are  the  generalized  forces  associated  with  reference,  elastic,  and  absolute  nodal 
coordinates,  and  Qc  is  a  quadratic  velocity  vector  that  results  from  the  differentiation  of  the 
kinematic  constraint  equations  twice  with  respect  to  time,  that  is 

cPP=Qc 

The  augmented  form  of  the  equations  of  motion  can  be  solved  in  order  to  obtain  the  second  time 
derivative  of  the  vectors  of  reference,  elastic,  absolute  nodal  coordinates  and  surface  parameters 
as  well  as  the  vector  of  Lagrange  multipliers.  Lagrange  multipliers  can  be  used  to  determine  the 
generalized  constraint  forces  associated  with  the  reference,  elastic,  and  absolute  nodal 
coordinates.  The  reference,  elastic,  absolute  nodal  accelerations  and  the  time  derivatives  of  the 
surface  parameters  can  be  integrated  forward  in  time  in  order  to  determine  the  coordinates  and 
velocities.  The  numerical  algorithm  used  in  this  investigation  ensures  that  the  algebraic  constraint 
equations  are  not  violated. 
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The  vector  of  Lagrange  multipliers  can  also  be  used  to  determine  the  normal  contact 
forces.  These  normal  contact  forces  can  be  used  to  determine  the  creep  forces  required  for 
accurate  modeling  of  railroad  vehicle  system  applications. 


5.  CHOLESKY  COORDINATES 

Since  the  mass  matrix  associated  with  the  absolute  nodal  coordinates  is  constant,  a  Cholesky 
transformation  can  be  used  to  obtain  a  generalized  identity  mass  matrix.  This  will  lead  to  an 
optimum  sparse  matrix  structure  for  the  augmented  form  of  the  equations  of  motion  of  the 
system.  The  resulting  augmented  form  of  the  equations  of  motion  can  be  written  as  follows: 
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where  I  is  an  identity  matrix,  and  subscript  ch  refers  to  Cholesky  coordinates. 
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1.  Introduction 

Multibody-based  methodologies  are  currently  being  used  to  simulate  and  analyze  a  wide  variety  of 
mechanical  systems.  In  biomechanical  applications,  in  particular,  these  methodologies  present  several 
advantages  since  they  provide  a  way  of  calculate  the  internal  forces  developed  by  a  specific  biomechanical 
model  during  the  execution  of  a  specified  task,  without  using  intrusive  force  measuring  devices.  In 
particular  when  associated  with  proper  optimization  tools,  these  methodologies  can  be  used  to  solve  the 
‘redundant  problem  in  biomechanics’  [1],  calculating  the  muscle  forces  produced  by  a  specified  muscle 
apparatus. 

It  is  the  purpose  of  this  work  to  present  a  multibody  based  methodology  that  together  with  the  use  of 
optimization  tools,  allows  for  the  calculation  of  the  redundant  muscle  forces,  generated  in  a  particular 
muscle  apparatus  of  the  human  body.  The  proposed  methodology  uses  a  multibody  formulation  with 
natural  coordinates  where  rigid  bodies  and  kinematic  joints  are  modeled  using  the  Cartesian  coordinates  of 
a  set  of  anatomical  points  and  unit  vectors  [2,3],  Using  this  general-purpose  methodology,  a  whole-body- 
response  biomechanical  model  is  constructed. 

Two  different  types  of  actuators  are  used  to  drive  the  biomechanical  model  through  a  previously 
acquired  motion:  joint  actuators,  that  drive  the  degrees-of-freedom  of  the  biomechanical  model  associated 
with  joints  where  muscles  are  not  modeled,  and  muscle  actuators  that  drive  the  degrees-of-freedom  of  the 
joints  crossed  by  the  muscles  forming  the  muscle  apparatus  under  analysis.  The  use  of  muscle  actuators  to 
drive  the  mechanical  model  generates  a  mechanical  system  with  a  redundant  nature,  with  more  unknowns 
to  determine  then  available  equations  of  motion. 

Optimization  tools  are  used  to  resolve  this  indeterminate  problem.  These  tools  consider  that  muscle 
forces  are  generated  according  to  the  minimization  of  some  performance  criteria  and  that  any  optimal 
solution  obtained  for  the  muscle  forces  must  satisfy  the  equations  of  motion  of  the  biomechanical  system. 
These  performance  criteria  are  analytical  expressions  that  simulate  the  decisions  taken  by  the  central 
nervous  system  when  executing  of  the  prescribed  task. 

To  each  muscle  actuator  is  associated  a  muscle  model  that  simulates  the  muscle  activation-contraction 
dynamics  [9,10,11],  In  the  present  work,  a  Hill  type  muscle  model  is  applied,  being  the  force  produce  by 
the  muscle  contractile  element  calculated  as  a  function  of  the  muscle  activation,  maximum  isometric  peak 
force,  muscle  length  and  muscle  shortening  rate  [23,24], 

2,  Multibody  Formulation  and  System  Equations  of  Motion 

A  multibody  formulation,  using  natural  or  fully  Cartesian  coordinates,  is  applied  to  the  study  and  analysis 
of  the  human  body  movement.  With  this  formulation,  rigid  bodies  are  constructed  using  the  Cartesian 
coordinates  of  a  set  of  points  and  unit  vectors.  These  points  and  unit  vectors,  usually  located  at  the  joints 
and  extremities  of  the  model,  are  used  not  only  to  define  the  kinematic  structure  of  the  rigid  bodies,  but 
also,  when  shared  by  different  rigid  bodies,  to  define  in  a  natural  way  simple  kinematic  joints  such  as  the 
spherical  and  revolute  joints. 

A  vector  of  generalized  coordinates  is  constructed  with  the  Cartesian  coordinates  of  the  points  and 
vectors  used  in  the  definition  of  the  mechanical  system: 

?293’--<7„}T  (1) 

where  n=3(np+nv)  is  the  total  number  of  natural  coordinates  and  np  and  nv  are,  respectively,  the  total 
number  of  points  and  unit  vectors  of  the  model. 

The  set  of  natural  coordinates,  presented  in  equation  (1),  is  necessary  to  the  definition  of  the  mechanical 
system,  but  it  is  not  sufficient.  In  order  to  completely  define  its  kinematic  structure  and  topology,  some 
kinematic  constraint  equations  must  be  supplied.  There  are  several  types  of  constraint  equations  that  are 
used  in  formulations  using  natural  coordinates:  rigid  body  constraints,  joint  constraints  and  driving 
constraints.  Rigid  body  constraints,  however,  are  the  most  common  type  since  the  number  of  natural 
coordinates  that  defines  a  rigid  body  is  always  larger  then  the  number  of  its  degrees-of-freedom  [2,3],  This 
means  that  not  all  the  coordinates  are  independent  and  that  kinematic  constraint  equations  need  to  be  added 
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to  express  these  dependences.  Rigid  body  constraints,  express  physical  properties  of  rigid  bodies  such  as 
the  constant  distance  between  two  points,  the  constant  angle  between  two  segments  or  the  constant  length 
of  a  vector.  Mathematically  these  physical  properties  are  supported  by  the  scalar  product  equation,  given 
by: 

0>(5/>,1)(q,0  =  vtu-Lv4cos(<v,u>(0)  =  0  (2). 

where  v  and  u  are  two  generic  vectors  used  in  the  definition  of  rigid  bodies,  Lv  and  Lu  are  the  respective  norms 
and  <v,u>(f)  is  the  angle  between  them.  Equation  (2)  is  also  applied  to  the  definition  of  kinematic  joints  and 
driving  constraints.  In  the  case  of  driving  constraints,  used  to  prescribe  the  motion  of  the  system,  this  angle  is  a 
function  of  time. 

There  are  other  types  of  kinematic  constraints,  such  as  the  linear  combination  constraint  or  the  cross 
product  constraint  that,  are  also  used  when  modeling  with  natural  coordinates  [2].  All  the  constraint 
equations  associated  with  the  mechanical  system  aTe  assembled  in  a  single  vector  and  written  as: 

®(q,f)  =  0  (3) 

The  equations  of  motion  of  a  general  multibody  system,  with  relative  motion  between  rigid  bodies 
constrained  by  kinematic  joints  and  acted  upon  by  external  applied  forces  are  given  by: 

Mq  +  3>qX  =  g  (4) 

where  M  is  the  global  mass  matrix  of  the  system,  ®q  the  Jacobian  matrix  of  the  constraints,  q  the  vector  of 
generalized  accelerations,  g  the  generalized  force  vector  and  X  the  vector  of  Lagrange  multipliers  [2,13,14], 
When  performing  inverse  dynamic  analyses  in  mechanical  systems,  the  Lagrange  multipliers  vector,  directly 
associated  with  the  reaction  forces  and  with  driving  forces  and  moments,  such  as  muscle  forces  and  net  moments 
of  force  at  the  joints  of  a  biomechanical  model,  is  the  only  unknown  present  in  equation  (4).  All  other  quantities 
are  calculated  from  kinematic  data  and  force  measuring  devices. 

3.  The  Biomechanical  Model 

In  this  work,  a  three-dimensional,  whole-body  response  biomechanical  model  of  the  human  body  is  used 
[3,5,6,12].  The  model,  presented  in  Figure  1,  is  described  using  the  general  multibody  formulation 
presented  before.  It  has  a  kinematic  structure  made  of  thirty-three  rigid  bodies,  interconnected  by  revolute 
and  universal  joints,  adding  to  the  sixteen  anatomical  segments,  described  in  Table  1. 


Figure  1.  a)  Sixteen  anatomical  segments;  b)  Kinematic  structure  of  rigid  bodies  and  kinematic  joints. 

A  collection  of  physical  characteristics  is  associated  to  each  anatomical  segment  of  the  biomechanical  model. 
The  most  important  are:  mass,  principal  moments  of  inertia,  segment  lengths  and  distance  of  its  center  of  mass 
from  the  proximal  joint.  The  properties  mentioned  before  are  obtained  from  the  literature,  relative  to  the  50 
percentile  human  male  [4,5,15].  However,  in  order  to  improve  the  biofidelity  of  the  data  with  respect  to  the 
anthropometries  of  the  subject  under  analysis,  these  physical  properties  are  scaled  using  proper  non-dimensional 
scaling  factors  [4,5], 

In  order  to  perform  the  inverse  dynamic  analysis,  the  motion  of  the  subject  needs  to  be  acquired.  For  this 
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purpose,  the  trajectories  of  a  set  of  points,  located  at  the  joints  and  extremities  of  the  biomechanical  model  [16] 
are  obtained  using  three-dimensional  motion  reconstruction  techniques  [18,19,20,21],  After  reconstruction, 
these  trajectories  are  filtered  in  order  to  reduce  the  noise  levels  introduced  during  the  motion  reconstruction 
procedure  [15,19]  and  they  are  corrected  to  be  consistent  with  the  kinematic  structure  of  the  biomechanical 
model  [16,17],  Velocity  and  acceleration  curves  are  calculated,  for  each  point,  using  the  time  differentiation  of 
the  cubic  spline  trajectory  curves. 

TABLE  I.  Anatomical  segments  description  with  rigid  bodies  topology. 


Segment  Nr. 

Description 

Rigid  Body  Nr. 

1 

Lower  torso 

6,7,8 

2 

Upper  torso 

19,20,21,22,23,24,25 

3 

Head 

33 

4 

Right  upper  arm 

17,18 

5 

Right  lower  arm 

15,16 

6 

Left  upper  arm 

26,27 

7 

Left  lower  arm 

28,29 

8 

Right  upper  leg 

4,5 

9 

Right  lower  leg 

2,3 

10 

Left  upper  leg 

9,10 

11 

Left  lower  leg 

11,12 

12 

Neck 

31,32 

13 

Right  hand 

14 

14 

Left  hand 

30 

15 

Right  Foot 

1 

16 

Left  foot 

13 

Another  important  input  data  are  the  externally  applied  forces  over  the  biomechanical  model.  In  this  work, 
the  feet  ground  reaction  forces  at  collected  using  three  force  plates. 

In  order  to  drive  the  biomechanical  model  throughout  the  inverse  dynamic  analysis,  joint  actuators  such  as 
the  one  represented  in  Figure  2  for  the  knee  joint,  must  be  specified.  This  means  that  for  each  degree-of- 
freedom,  a  joint  actuator  equation  is  added  to  the  equations  of  motion  of  the  system. 


Figure  2.  Joint  actuator  associated  with  the  knee 

Joint  actuator  equations  are  kinematic  constraints,  of  scalar  product  type  as  presented  in  equation  (2),  in 
which  the  angle  between  the  two  vectors  is  a  function  of  time  and  describes,  for  each  time  step,  the  motion  of  the 
kinematic  joint  associated  with  that  degree-of-freedom.  These  additional  equations  are  added  to  the  constraints  in 
such  a  way  that  the  number  of  non-redundant  constraint  equations  becomes  equal  to  the  number  of  natural 
coordinates  describing  the  model.  It  should  be  noted  that  the  inverse  dynamics  problem,  as  stated  here,  is 
determined,  i.e.,  equation  (4)  has  a  solution  and  that  solution  is  unique. 

4.  Redundant  Muscle  Forces  and  Optimization  Techniques 

In  complex  biomechanical  systems  such  as  the  human  body,  almost  every  joint  is  crossed  by  several  muscles  or 
muscle  groups.  This  means  that  different  muscle  activation  patterns  can  generate  forces  that  produce  the  same 
net  moments-of-force  at  the  joints  and  as  result  a  same  posture  or  movement.  It  is  the  central  nervous  system 
that,  depending  on  the  task  being  performed  and/or  the  objectives  to  be  achieved,  selects  and  activates  the  set  of 
muscles  that  best  fulfill  some  physiological  criteria. 

Historically  termed  ‘the  redundant  problem  in  biomechanics’  [1],  this  redundancy  results,  from  a 
mathematical  point  of  view,  from  the  fact  that  the  number  of  load-transmitting  elements  at  a  joint  usually 
exceeds  the  number  of  available  equilibrium  equations  and  consequently  a  unique  solution  for  the  analytical 
determination  of  those  forces  cannot  be  obtained  [7],  Optimization  techniques  are  applied  to  resolve  the 
indeterminate  problem  and  to  choose,  from  an  infinite  set  of  solutions,  the  optimal  solution  that  minimize  one  or 
more  cost  functions. 

4. 1 .  MUSCLE  ACTUATORS  IN  MULTIBODY  SYSTEMS 

Muscles  are  introduced  in  the  equations  of  motion  of  the  multibody  system  as  point-to-point  kinematic 
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driver  actuators.  Depending  on  their  complexity,  muscle  actuators  can  be  defined  using  two  or  more 
points.  In  Figure  3,  two  muscles  of  the  lower  extremity  muscle  apparatus  are  presented  to  illustrate  the  two 
types  of  muscle  definition:  the  semimembranosus  and  the  tensor  fasciae  latea  [22].  The  first  one  is  a  two- 
point  muscle  defined  only  with  an  origin  and  an  insertion  point,  while  the  second  one,  due  to  a  more 
complex  path,  uses  two  additional  via  points  for  a  more  accurate  definition. 


Tensor 

Fasciae 

Latae 


Figure  3.  Muscle  actuators  defined  with  two  or  more  points. 

To  each  muscle  actuator  is  associated  a  constraint  equation  that  specifies  the  muscle  action  during  the 
analysis  period.  These  expressions,  constrain  the  distance  between  two  generic  points,  of  different  rigid  bodies, 
to  vary  according  to  a  specified  length  change  history,  calculated  before  hand.  Considering  a  two-point  muscle 
actuator,  with  an  origin  located  in  point  n  of  rigid  body  i,  and  an  insertion  located  in  point  m  of  rigid  bodyy,  the 
mathematical  expression  used  to  define  the  constraint  is  written  as: 

Owl)(q,0  =  (rm  -rj(rm  -r„)-lL(0  =  0  (5) 

where  rm  and  r„  are  respectively  the  global  position  vectors  of  the  origin  and  insertion  points  and  Lnm(t)  is  the 
muscle  total  length,  calculated  for  each  time  step  of  the  analysis.  Note  that  n  and  m  are  two  generic  points  of 
rigid  bodies  i  and  j  and  are  used  only  to  define  the  muscle  actuator.  This  means  that  a  coordinate  transformation 
needs  to  be  applied  in  order  to  explicitly  express  this  equation  in  terms  of  the  natural  coordinates  used  in  the 
construction  of  rigid  bodies  i  and  j  [28], 

To  each  muscle  actuator  a  Lagrange  multiplier  is  associated.  When  considering  this  type  of  actuators,  the 
physical  meaning  of  this  multiplier  is  of  a  force  per  unit  of  length.  In  order  to  obtain  muscle  forces  or  muscle 
activations,  these  multipliers  must  be  multiplied  by  proper  scalar  factors  [28], 

It  should  be  noted  that  muscle  driver  actuator  equations  are  introduced  in  the  Jacobian  matrix  of  the 
constraints  together  with  the  kinematic  constraint  equations  defining  the  kinematics  of  the  biomechanical  model 
and  the  kinematic  joints.  This  means  that  an  integrated  solution  is  obtained  for  the  inverse  dynamics  problem  in 
terms  of  muscle  and  reaction  forces. 


4.2.  DYNAMICS  OF  MUSCLE  TISSUE 

The  dynamics  of  muscle  tissue  can  be  divided  into  activation  dynamics  and  muscle  contraction  dynamics 
[9],  as  schematically  indicated  in  Figure  4. 


Neural  Signal  ^ 

Activation 

Muscle  Activation  ^ 

Muscle  Contraction 

Muscle  Force  ^ 

► 

Dynamics 

- ^ 

Dynamics 

"  '  ► 

Figure  4.  Dynamics  of  muscle  tissue. 

Activation  dynamics  generates  a  muscle  tissue  state  that  transforms  the  neural  excitation  produced  by 
the  central  nervous  system,  into  activation  of  the  contractile  apparatus.  Activation  dynamics,  although  not 
implemented  in  this  work,  describes  the  time  lag  between  neural  signal  and  the  corresponding  muscle 
activation  [11]  and  it  is  usually  represented  in  a  microscopic  level  by  first  order  differential  equations 
[10, li]. 

Muscle  contraction  dynamics  corresponds  to  the  transformation  of  muscle  activation  in  muscle  force,  as 
represented  in  Figure  4.  To  simulate  this  process,  a  mathematical  model  of  the  muscle  needs  to  be 
introduced.  In  the  present  work,  a  Hill-type  muscle  model  is  applied  to  the  simulation  of  the  muscle 
contraction  dynamics.  This  model  is  nowadays  extensively  applied  to  the  study  of  intermuscular 
coordination  of  biomechanical  systems  [9]. 

The  model,  depicted  in  Figure  5,  is  composed  of  an  active  Hill  contractive  element  (CE)  and  a  passive 
element  (PE).  Both  elements  contribute  to  the  total  muscle  force  Fm{t).  In  the  present  work,  a  series  elastic 
element  (SEE)  usually  associated  with  cross-bridge  stiffness  is  not  included  in  the  model  since  it  can  be 
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neglected,  with  little  inaccuracy,  in  coordination  studies  not  involving  short -tendon  actuators  [9], 

In  a  Hill-type  muscle  model,  the  contractile  properties  of  the  muscle  tissue  are  controlled  by  its  current 
length  Lm(t),  rate  of  length  change  Lm(t)  and  activation  am(t)  in  such  a  way  that  the  force  produced  by  the 
active  Hill  contractile  element,  for  muscle  m,  is  written  as: 


Fo 


where  F0m  is  the  maximum  isometric  force  and  F"  {Lm  (/))  and  F[{Lm(t))  are  two  functions  that  represent  the 
muscle  force-length  and  force-velocity  dependency,  respectively  [9,11]. 

The  passive  element  is  independent  of  activation  and  it  only  starts  to  produce  force  when  the  muscle  is 
stretched  beyond  its  resting  length  L" .  It  should  be  noted  that  force  produced  by  the  passive  element  is  only 
function  of  the  muscle  length,  being  its  value  perfectly  determined  during  the  total  time  of  the  analysis. 
Therefore,  the  force  produced  by  the  passive  element  is  treated  as  an  external  force,  applied  directly  to  the  rigid 
bodies  interconnected  by  the  muscle. 


A  muscle  apparatus  of  thirty-five  muscle  actuators  is  used  to  simulate  the  right  lower  extremity 
intermuscular  coordination.  The  physiological  information  regarding  muscle  definition  is  obtained  from 
literature  [23,24]  and  compiled  in  a  muscle  database.  This  information  consists  in  the  maximum  isometric 
force,  resting  length,  attachment  and  wrap-around  bodies  and  the  local  coordinates  of  the  origin,  insertion 
and  via  points.  The  whole  muscle  apparatus  is  presented  in  Figure  6. 


Figure  6.  Lower  extremity  muscle  apparatus. 


4.3.  STATIC  OPTIMIZATION:  COST  FUNCTIONS  AND  CONSTRAINTS 

Indeterminate  systems  present  an  infinite  set  of  possible  solutions,  being  the  aim  of  optimization  techniques  to 
find,  from  all  the  possible  solutions,  the  one  that  minimize  a  prescribed  objective  function,  subjected  to  a  certain 
number  of  restrictions  or  constraints.  Mathematically  optimization  problems  can  be  stated  as  follows: 

f//«,)  =  0  j  =  U,nec 

minimize  F0(u,)  subject  to:-  //«,)>  0  j  =  (nec  +  e  (7) 

uT  <^<1^  i  =  l, 

where  u,  are  the  state  variables  bounded  by  «/ower  and  u,uppcr,  F0(ut)  is  the  objective  or  cost  function  to  minimize 
and  f  j  (u, )  are  constraint  equations  that  restrain  the  state  variables.  In  equation  (7),  ns,  represents  the  total 
number  of  state  variables  and  n,c  the  total  number  of  constraint  equations  in  which  nec  are  of  equality  type. 
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The  minimisation  of  cost  functions,  simulate  physiological  criteria  adopted  by  the  central  nervous  system 
when  deciding  which  muscles  to  recmit  as  well  as  the  level  of  activation  that  produce  the  adequate  motion  or 
posture  for  the  task  being  undertaken.  Several  cost  functions  have  been  used  by  researchers  in  the  study  of  the 
redundant  problem  in  biomechanics  [1,7,8],  The  principle  of  minimization  of  the  sum  of  the  cube  of  the 
individual  muscle  stresses  [8],  used  in  applications  involving  human  locomotion,  is  adopted  in  the  present  work. 
This  principle  is  expressed  by  the  following  cost  function: 


where  nma  are  the  number  of  muscle  actuators  and  a  is  the  specific  muscle  strength  with  a  constant  value  of 
31.39  N/cm2  [23,24].  Note  that  only  state  variables  associated  with  muscle  actuators  are  used  to  evaluate  the 
cost  functions,  although  the  complete  set  of  state  variables  also  include  the  Lagrange  multipliers  associated  with 
the  rest  of  the  kinematic  constraints.  Using  these  cost  functions,  the  state  variables  associated  with  muscle 
actuators  represent  muscle  activations  and,  for  that  reason,  can  only  assume  values  between  0  and  1.  For  all 
other  state  variables  no  bounds  are  specified. 

The  optimal  solution,  obtained  by  the  optimization  routine  for  the  state  variables,  must  fulfill  the  equations  of 
motion  of  the  mechanical  system,  given  by  equation  (4).  Therefore,  these  equations  are  supplied  to  the  optimizer 
as  constraint  equations  for  the  state  variables. 

5.  Application  Case 

The  methodologies  and  the  biomechanical  model  described  before  are  applied  to  the  gait  analysis  of  a  subject 
performing  a  normal  cadence  stride  period.  The  subject  under  analysis  is  a  25-year-old  male  with  a  height  of 
1.70  m  and  a  total  body  mass  of  70  kg.  The  subject  is  wearing  miming  shoes.  The  trial  starts  at  the  time  step 
just  before  right  heel  contacts  the  floor,  and  continues  until  the  subsequent  occurrence  of  the  same  foot.  During 
the  stride  period,  the  subject  has  to  walk  over  three  force  plates  that  measure  the  ground  reaction  forces  for  both 
feet  [5,6],  A  total  number  of  66  frames  are  recorded  using  four  cameras  with  a  sampling  frequency  of  60  Hz. 

The  net  moments  of  force  developed  at  the  joints  of  the  biomechanical  model  are  calculated.  In  particular, 
the  net  moments  of  force  for  the  joint  actuators  of  the  right  ankle,  knee  and  hip  joints  are  presented  in  Figure  7. 
These  results  are  within  the  expected  values  reported  in  the  literature  for  a  normal  cadence  stride  [27]. 

The  muscle  forces  developed  in  the  right  leg  during  the  stride  period  are  calculated  using  the  procedures 
described  before.  The  results  obtained  with  two  optimization  packages  [25,26],  are  presented  in  Figure  8  for  the 
muscle  Gluteus  Minimus,  an  abductor  of  the  hip  and  for  Gluteus ,  a  powerful  plantar  flexor  of  the  ankle  [22], 


Figure  7.  Net  moment-of-force  (scaled  by  the  body  mass)  for  the  right  ankle,  knee  and  hip  joints. 


a)  b) 

Figure  8.  Muscle  Forces:  a)  Gluteus  Minimus,  b)  Soleus. 

The  results  present  a  good  correlation  between  both  optimization  routines.  In  general  terms,  the  forces 
present  almost  the  same  behavior  although  different  force  levels  can  be  identified.  It  should  be  noted  that  the 
results  presented  in  Figure  8  are  two  possible  solutions  obtained  by  different  optimization  packages  and  that  both 
solutions  fulfill  the  equations  of  motion  of  the  system. 
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6.  Conclusions 


In  this  work,  a  methodology  was  presented  that  allows  for  the  calculation  of  the  net  moments-of-force  and 
reactions  at  the  joints,  and  also  for  the  calculation  of  the  muscle  forces  developed  in  a  specific  muscle 
apparatus  of  a  subject  describing  a  prescribed  motion.  The  subject  is  simulated  using  a  whole-body- 
response  biomechanical  model  constructed  using  a  multibody  formulation  with  natural  or  fully  Cartesian 
coordinates. 

The  model  is  driven  through  the  prescribed  motion  using  kinematic  driver  actuators  of  two  types:  joint 
driver  actuators  and  muscle  driver  actuators.  To  each  driver  actuator  is  associated  a  Lagrange  multiplier 
that,  depending  on  the  actuator  type,  represents,  for  the  case  of  a  joint  actuator,  the  net  moment-of-force 
produced  by  all  the  muscles  crossing  the  specified  joint,  or,  in  the  case  of  the  muscle  actuator,  the  muscle 
force  associated  with  a  specified  muscle  or  muscle  complex. 

It  was  showed  that  the  use  of  muscle  actuators  usually  introduces  indeterminacy  in  the  equations  of 
motion  of  the  biomechanical  system.  When  this  occurs,  optimization  techniques  present  a  powerful  tool 
that  allows  for  the  selection,  among  an  infinite  set  of  possible  solutions,  of  the  one  that  minimizes  a 
specific  cost-function  associated,  from  the  physiological  point  of  view,  with  the  criteria  used  during  the 
trial  by  the  central  nervous  system  of  the  subject. 
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1.  Introduction 

The  paper  deals  with  the  description  of  knowledge  support  of  virtual  modelling  and  simulation.  The  design 
methodology  based  on  multidisciplinary  virtual  modelling  and  subsequent  simulation  is  essential  for  nowadays 
any  engineering  design  [1],  but  specifically  for  design  of  complex  mechatronic  machines  [2],  Besides  that 
current  engineering  design  is  multidisciplinary  and  therefore  based  on  team  work.  The  team  work  often  uses  the 
possibility  and  benefits  of  geographic  distribution  and  internet  communication  within  the  team.  Engineering 
design  draws  heavily  on  previous  experience  and  therefore  it  is  essentially  to  build  and  maintain  the  archives  of 
previous  cases.  It  is  done  in  some  way  also  for  simulation  models. 

Engineering  design  is  in  nature  a  knowledge  intensive  activity,  but  analysing  the  resulting  documentation  of 
such  activities  shows  that  there  is  a  significant  loss  of  knowledge  for  team  communication  and  future  reuse.  The 
simulation  of  dynamic  systems,  in  particular  the  nonlinear  virtual  multibody  system,  is  a  prime  example.  The 
resulting  simulation  models  do  not  include  the  majority  of  knowledge  which  was  necessary  and  which  was  used 
for  their  development. 

The  simulation  models  include  a  large  amount  of  knowledge,  which  is  related  to  the  development  and  usage 
of  dynamic  simulation  models.  However,  there  are  no  tools  for  storing,  retrieving,  reusing,  sharing  and 
communicating  such  knowledge.  Therefore  special  tools  are  being  developed  for  enriching  traditional  dynamic 
simulation  models  by  the  corresponding  accompanying  knowledge. 

2.  Knowledge  Life  Cycle  of  Virtual  Modelling  and  Simulation 

The  development  of  a  virtual  model  and  then  its  simulation  typically  goes  through  a  number  of  tasks.  These 
tasks  are  illustrated  in  Figure  1,  the  light  arrows  represent  mappings  between  the  different  elements  and  the  black 
arrows  represent  transformation  processes  between  the  tasks.  The  development  of  a  simulation,  as  shown  in 
Figure  1,  involves  five  steps. 

The  first  step  is  the  analysis  of  the  real  world,  since  when  it  is  started  to  develop  a  simulation  there  exists 
some  real  world  object  (either  actual  or  hypothesised).  This  real  world  object  is  investigated  within  certain 
experimental  frame  concentrated  on  the  interested  behaviour  in  order  to  answer  some  question,  the  objective  of 
object  investigation.  It  forms  the  real  world  system  (either  actual  or  hypothesised).  From  this  real  world  system 
we  want  to  create  a  model  to  use  to  answer  a  modelling  question  (question),  such  as  how  a  real-world  system 
would  respond  to  particular  stimuli.  The  real  world  task  has  three  elements,  these  elements  are  the  real  world 
system,  the  question  (modelling  question)  and  finally  the  solution: 

•  The  real  world  system  (either  actual  or  hypothesised),  of  which  we  want  to  create  a  model  to  use  to  answer  a 
modelling  question,  such  as  how  a  real-world  system  would  respond  to  particular  stimuli. 

•  The  question  (modelling  question)  is  a  question  that  is  based  within  the  real  world  and  is  to  be  answered 
using  simulation. 

•  The  solution  is  the  interpretation  of  the  interpreted  output  of  the  simulation  task,  this  will  be  left  blank  until 
there  is  a  set  of  results. 
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Figure  1.  Knowledge  life  cycle  of  virtual  modelling  and  simulation 


The  second  step  is  the  conceptual  task,  where  the  conceptual  model  is  developed.  The  transformation 
from  real  world  into  conceptual  world  consists  of  creating  hierarchical  break-down  of  the  real  world  system 
being  investigated  (e.g.  hierarchical  description  of  real  product  components  and  its  environment).  This  scheme 
should  be  accompanied  by  the  description  of  function  (physical  interaction)  as  it  is  the  basis  of  causal  and 
functional  explanation.  As  soon  as  this  description  is  completed  the  conceptualisation  is  completed.  Certainly 
there  are  raised  different  assumptions  about  the  granularity  of  the  modelling  being  provided.  It  is  the  way  of 
"thinking  about"  and  representing  the  real  world  system  in  a  conceptual  manner.  A  crucial  design  decision  is 
determination  of  what  factors  influence  system  behaviour  and  what  system  behaviours  are  to  be  incorporated 
into  this  task.  The  result  of  the  conceptualisation  is  the  conceptual  model  investigated  within  the  modelling 
environment  in  order  to  answer  the  modelling  objective: 

•  The  conceptual  model  is  an  abstracted  view  of  the  real  world  system. 

•  The  modelling  objective  is  the  conceptualisation  of  the  question  and  form  the  objectives  for  the  simulation 
task  (i.e.  what  behaviour  we  are  interested  in?  and  how  we  will  know  that  we  have  the  correct  answer  from 
the  results?) 

The  modelling  environment  is  the  conceptualisation  of  the  inputs  of  the  real  world  systems,  providing  a 
simulation  environment  to  work  within  in  the  simulation  task,  typically  the  inputs  are  specified  here. 

The  process  of  determining  whether  the  conceptual  model  is  an  adequately  accurate  representation  of  the  real 
world  task  is  the  validation. 

The  next  task  is  the  physical  modelling.  The  third  step  is  the  transformation  from  conceptual  world  into 
physical  world.  It  consists  of  replacement  of  each  element  on  conceptual  level  by  corresponding  element  on 
physical  level.  The  elements  of  physical  model  are  the  so-called  ideal  modelling  elements  (e.g.  rigid  body, 
ideally  flexible  body,  ideal  gas,  ideal  incompressible  fluid,  ideal  capacitor  etc.).  The  engineering  sciences  deal 
exactly  with  the  ideal  objects.  The  mathematically  described  exact  prediction  of  the  behaviour  is  available  only 
for  ideal  objects.  The  art  of  engineering  modelling  and  simulation  is  the  capability  to  translate  the  behaviour  of 
real  world  objects  into  the  behaviour  of  system  consisting  of  ideal  objects. 

Again  as  soon  as  this  replacement  is  completed  the  physical  modelling  is  completed.  Exactly  here  the 
majority  of  modelling  assumptions  is  raised  and  exactly  here  many  modelling  modifications  are  being  done.  It  is 
the  way  of  "modelling  it"  and  representing  the  real  world  system  in  a  physical  modelling  manner.  For  example 
two  typical  modifications  are  provided:  Either  an  element  is  decomposed  into  more  elements  (a  small 
subsystem)  (e.g.  a  body  cannot  be  treated  as  rigid  body  and  it  is  modelled  as  flexible  body  being  modelled  as 
subsystem)  or  several  elements  are  replaced  by  one  element  as  the  detailed  treatment  of  interactions  is  neglected 
(e.g.  the  influence  of  a  suspension  mechanism  can  be  neglected  and  the  model  consists  only  of  chassis  and 
wheels  with  flexibility  of  tyre  and  suspension  spring).  The  modelling  task  results  into  the  physical  model,  its 
input  and  the  investigated  output: 

•  The  physical  model  is  an  accurate  physical  view  of  the  conceptual  model. 

•  The  model  input  is  the  modelling  conceptualisation  of  the  inputs  of  the  real  world  systems,  providing  a 
physical  modelling  of  the  real  world  stimuli  to  the  investigated  system,  i.e.  detailed  physical  description  of 
modelling  environment  from  conceptual  task. 

•  The  model  output  is  the  modelling  conceptualisation  of  the  objectives  for  the  simulation  task  (i.e.  how  the 
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interested  behaviour  is  measured  and  evaluated  ?) 

The  process  of  determining  whether  the  physical  model  is  an  adequately  accurate  representation  of  the 
conceptual  model  is  the  verification. 

The  results  of  modelling  task  are  implemented  in  the  form  of  a  computer-executable  set  of  instructions 
known  as  the  simulation  model.  It  is  the  transformation  from  physical  world  into  simulation  world.  It  consists  of 
replacement  of  each  element  on  physical  modelling  level  by  corresponding  element  on  simulation  level.  Usually 
this  replacement  can  be  straightforward  as  simulation  packages  are  trying  directly  contain  the  ideal  objects  of 
physical  models.  However,  always  some  modifications  are  necessary.  The  simulation  task  consists  of  two  stages. 
The  first  stage  deals  with  the  implementation  of  the  physical  model  using  particular  simulation  environment 
(simulation  language  and  simulation  software).  The  second  stage  deals  with  the  simulation  experiment,  i.e. 
proper  usage  of  the  developed  simulation  model  for  the  solution  of  the  real  world  problem.  Testing  is  the  process 
of  determining  whether  the  implemented  version  of  the  model  is  an  accurate  representation  of  the  physical 
model. 

Between  the  models  from  different  worlds  there  are  many  relations.  The  main  relations  are  connected  with 
the  described  transformations.  They  represent  the  relation  “consist  of’  from  real  world  to  conceptual  world,  the 
relation  “is  modelled  as”  from  conceptual  world  to  modelling  world  and  the  relation  “is  implemented  as”  from 
modelling  world  to  simulation  world  and  finally  the  relation  “is  simulated  by”  and  “is  answered  by”  from  real 
world  to  simulation  world.  The  development  of  objects  of  these  relations  is  accompanied  by  many  iterations 
(Fig.  2). 


Real  world 


Conceptual  world 


Modelling  world 


Simulation  world 


Figure  2.  Iterative  process  of  simulation  model  development 

3.  Knowledge  Support  of  Virtual  Modelling  and  Simulation 

The  above  described  process  of  creating  of  virtual  models  and  simulation  experiments  with  them  is 
accompanied  with  supporting  knowledge  that  is  vital  for  knowledge  sharing  and  reuse  within  the  design  team.  It 
is  believed  that  the  supporting  knowledge  for  the  modelling  and  simulation  process  comes  in  two  forms, 
informal  and  formal  knowledge.  Informal  knowledge  is  typically  concerned  about  relationships  and  knowledge 
about  models  using  natural  language.  Formal  knowledge  is  also  concerned  with  the  establishment  and 
representation  of  knowledge  about  the  model,  but  this  knowledge  is  typically  more  structured  using  knowledge 
modelling  technology.  Both  of  these  types  of  knowledge  will  be  associated  with  each  world  object  as  shown  in 
Figure  3. 


Figure  3.  Supporting  knowledge  for  the  modelling  and  simulation  process 

Based  on  the  methodology  of  Enrich  project  [3]  the  modelling  and  simulation  objects  are  work  documents  of 
engineering  activity,  the  informal  knowledge  can  be  captured  by  annotations  and  the  formal  knowledge  by 
semantic  indexing  using  concepts  from  related  ontologies  (Fig.  5). 

Each  world  model  is  associated  with  informal  and  formal  knowledge  (Fig.  4)  on  the  level  of  model 
components  as  well  on  the  level  of  complete  models  and  besides  that  each  transition  between  worlds  is  also 
associated  with  informal  and  formal  knowledge.  The  informal  knowledge  about  world  object  components  and 
complete  world  object  is  describing  the  function,  behaviour  and  any  other  useful  information  about  the 
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component  or  object  in  question.  The  formal  knowledge  represents  the  most  valuable  informal  knowledge  in 
terms  of  corresponding  ontologies  (Fig.  5).  However,  only  the  ontologies  from  the  lowest  level  are  formally 
dscribed  and  used  for  semantic  indexing.  The  informal  knowledge  of  the  world  transitions  describes  the 
structural  changes  of  the  model  with  related  assumptions  raised  during  particular  transformation,  the  formal 
knowledge  of  these  transitions  describes  the  relationships  of  modelling  processes. 


Formal 

Informal 

Semantic 

indexes 

Annotation 

text 

1 

1 

Conceptual/ 

Physical/ 

Simulation/ 

Model 


KS&R  view 


S&Mview 


Figure  4.  Model  with  semantic  indexes  and  textual  annotation 


The  particular  relationships  between  cases  of  world  models  and  their  components  can  be  also  generalized  into 
more  abstract  knowledge  about  development  of  virtual  models  and  their  simulation  (general  rules)  (Fig.  6). 


Figure  5.  Ontology  hierarchy 


4.  Knowledge  Tools  for  Knowledge  Support  of  Virtual  Modelling  and  Simulation 

The  above  described  analysis  has  shown  that  the  process  of  modelling  can  be  described  on  the  level  of  each 
world  by  three  descriptors: 

i.  Conceptual/physical/simulation  model  depending  on  the  world  (CWO/MWO/SWO), 

ii.  Annotation  text  (informal  knowledge),  and 

iii.  Semantic  indexes  (formal  knowledge). 
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Figure  6.  Models,  ontologies  and  their  relationships 

In  order  to  support  these  descriptors  for  each  of  the  worlds,  the  transitions  between  them  and  the  whole 
project  data  there  have  been  created  and  resused  many  tools.  They  are: 

1.  Modelling  tools:  Simulation  package  for  Simulation  World  and  Modelling  tool  for  Conceptual  and  Modelling 
Worlds  (any  primitive  tools  like  drawing  creator  can  be  used  instead). 

2.  Tools  for  informal  knowledge:  Annotation  tool  for  simulation  models  (and  similarly  for  further  models  in 
modelling  tool),  Knowledge  management  tool  for  supporting  descriptions  of  all  objects  in  Knowledge  life  cycle 

(Fig-  1). 

3.  Tools  for  formal  knowledge:  Ontology  interface  tool  for  semantic  indexing  and  semantic  retrieval. 

4.  Life  cycle  management  tools:  Knowledge  management  tool  for  supporting  all  descriptions  and  related  files  on 
all  stages  of  Knowledge  life  cycle  (Fig.  1)  and  Database  tool  for  storing/retrieving  all  data. 


annotation 
context  element 
— - 1 - 


Figure  7.  Annotation  tool  for  simulation  models  (AT) 

Specifically  new  tools  are  the  Annotation  tool  (AT)  and  Knowledge  management  tool  (KMT).  In  order  to 
support  the  structure  of  models,  especially  of  simulation  models  the  annotation  texts  are  directly  associated  with 
model  elements  (Fig.  7).  It  is  the  Annotation  tool  of  models  [4],  Then  there  is  proposed  another  tool  for 
Knowledge  management  on  the  level  of  whole  models  and  worlds.  It  supports  the  annotations  of  whole  models 
and  transitions  between  worlds,  the  semantic  indexing  of  all  objects  and  hierarchical  relations  between  objects  of 
different  worlds  (Fig.  8). 

The  knowledge  management  tool  has  three  parts.  One  is  related  to  the  description  of  model  and  annotations 
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of  the  particular  world.  The  other  comprises  the  hierarchy  of  world  objects  and  their  formal  description.  The 
third  one  involves  the  discussion  space  as  the  tool  for  internet-based  communication  and  team  work. 
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Discussion 
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Search  engine 

Model  of  the  world 
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Further  world  components 

List  of  Files 

List  of  Documents 

List  of  following  worlds 

Figure  8.  Knowledge  management  tool  (KMT) 

The  usual  process  of  application  of  these  tools  is  following.  One  way  of  usage  is  just  creating  of  simulation 
project  cases.  The  problem  in  the  real  world  is  formulated.  The  slots  in  the  new  item  of  the  KMT  are  filled  in 
according  to  Fig.  1.  The  problem  is  semantically  indexed  using  the  upper  concepts  of  component  ontology.  The 
new  item  of  the  KMT  on  the  conceptual  layer  is  created.  The  Conceptual  model  is  created  using  the  Modelling 
tool.  It  may  be  annotated.  Nevertheless  the  slots  in  the  KMT  item  are  filled  in.  The  concept  is  semantically 
indexed  using  the  concepts  of  component  ontology.  The  new  item  of  the  KMT  on  the  modelling  layer  is  open. 
The  Physical  model  is  created  using  the  modelling  tool.  It  may  be  annotated.  The  slots  in  the  KMT  item  are 
filled  in.  The  physical  model  is  semantically  indexed  using  the  concepts  of  ideal  object  ontology.  Then  the 
implementation  of  simulation  model  starts.  The  new  item  of  the  KMT  on  the  simulation  layer  is  created.  The 
Simulation  model  is  created  using  the  simulation  package  and  it  is  annotated  using  AT.  The  slots  in  the  KMT 
item  are  filled  in.  The  simulation  model  is  semantically  indexed  using  the  concepts  of  simulation  object 
ontology.  If  the  tested  simulation  model  is  finished  then  the  real  simulation  experiments  start.  The  corresponding 
item  in  the  KMT  is  created  and  filled  in  with  description  of  contents  and  results  of  simulation  experiments.  They 
are  also  semantically  indexed  using  simulation  experiment  ontology.  Their  interpreted  results  are  described  and 
semantically  indexed  in  the  item  of  the  real  world  as  the  solution  to  the  initial  question. 

The  other  way  is  creating  of  simulation  project  case  but  with  usage  of  reuse  of  previous  cases.  The  process 
is  similar  to  that  one  above  described,  but  at  the  each  step  the  user  can  look  for  similar  previous  case  using  the 
semantic  search  based  on  the  semantic  indexes  from  the  appropriate  ontologies  to  the  solved  step  (Fig.  5). 

5.  Conclusions 

The  paper  describes  the  concepts  and  tools  for  knowledge  support  of  virtual  modelling  and  simulation.  These 
techniques  are  important  for  virtual  modelling  used  in  teams  and  for  reuse  typical  for  any  engineering 
methodology.  The  developed  tools  have  been  tested  on  cooperative  development  of  simulation  models  and  are 
being  currently  tested  on  the  reuse  of  simulation  models.  The  accumulated  experience  seems  to  suggest  to  apply 
the  developed  methodology  and  tools  for  other  engineering  design  tasks  dealing  with  other  kinds  of  virtual 
modelling. 
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1.  Introduction 

Multibody  systems  are  the  most  usual  models  of  mechatronic  systems.  Mechatronic  systems  use  the  synergy 
achieved  by  the  combination  of  properties  of  mechanical  (hardware)  systems  and  control  (software)  systems 
applied  by  electronic  devices.  Therefore  the  control  of  multibody  systems  is  very  important  topic  for 
mechatronic  design.  Multibody  systems  have  several  crucial  problems  compared  with  general  controlled 
systems.  They  make  their  control  to  be  a  challenge  in  many  cases.  Its  general  origin  is  the  usual  nonlinearity  of 

multibody  systems.  . 

This  paper  deals  with  the  description  of  these  specific  difficulties  and  with  the  description  of  mam 

current  approaches  for  their  solutions. 

2.  Main  Problems  of  Control  of  Multibody  Systems 

Multibody  systems  are  the  most  often  models  of  mechanical  systems  being  controlled.  They  concentrate  the 
mechanical  functionality  of  machines  to  be  enough  precise  on  one  hand  and  simultaneously  to  be  enough  concise 
for  control  on  the  other  hand.  The  main  difficulties  of  control  of  mechanical  (multibody)  systems  are  following: 

•  Mechanical  (multibody)  systems  are  usually  nonlinear  systems.  The  well  established  control  methods 
are  developed  for  linear  systems,  only  recently  there  have  been  developed  methods  for  control  of 
nonlinear  systems,  however  still  not  being  so  general  and  powerful  as  for  linear  systems. 

•  Nonlinearity  is  sometimes  essential  for  the  control  of  multibody  systems.  There  exist  multibody 
systems  (e.g.  nonholonomic  systems)  that  being  linearized  about  operation  point  become 
uncontrollable. 

•  Multibody  system  undergo  large  displacements  where  linearization  about  operation  point  is  impossible. 
The  control  problem  is  quite  often  not  just  stabilization  around  working  (equilibrium)  point,  but  the 
motion  from  one  state  into  another  one. 

•  Mechanical  (multibody)  systems  in  many  cases  have  different  number  of  inputs  and  outputs,  or 
different  number  of  inputs  and  degrees  of  freedom  (DOFs).  The  inputs  are  operated  by  actuators 
(drives).  Therefore  it  can  be  spoken  about  under-actuated,  equal-actuated  and  over-actuated  systems. 
This  is  causing  especially  problems  in  combination  with  nonlinearity  of  mechanical  systems. 

•  Multibody  systems  are  quite  often  suitably  described  by  redundant  coordinates.  Then  the  models  are 
described  by  differential-algebraic  equations  (DAE).  DAE  cannot  be  generally  and  easily  transformed 
into  ordinary  differential  equations  (ODE).  Only  ODE  can  be  described  by  state  space  models.  The 
absolute  majority  of  current  control  methods  suppose  that  the  dynamic  system  being  controlled  is 
described  by  ODE  and  thus  the  traditional  control  methods  are  difficult  to  be  applied. 

Let  us  summarize  the  usual  control  problems  to  be  solved  for  the  control  of  multibody  systems: 

•  The  first  fundamental  problem  is  to  stabilize  the  motion  of  multibody  system  around  its  equilibrium.  An 
important  subproblem  is  just  to  check  the  stability  of  some  proposed  control. 

•  The  next  problem  is  to  move  the  multibody  system  from  one  position  into  another.  This  problem  is 
transformed  into  other  problems.  The  problem  can  be  stated  as  the  global  stabilization  of  the  system 
from  the  initial  position  around  the  final  position  as  the  stabilized  equilibrium.  By  this  way  the  problem 
is  transformed  into  previous  problem.  The  other  problem  statement  is  to  stabilize  the  system  around  the 
given  trajectory  connecting  both  positions.  It  is  well  known  trajectory  tracking.  For  nonlinear  multibody 
systems  it  can  be  a  serious  problem  just  to  construct  admissible  trajectory  connecting  initial  and  final 
positions. 
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•  The  previous  problem  can  be  formulated  as  the  determination  of  optimal  trajectory  with  respect  to  some 
performance  index. 

•  The  problem  could  be  just  to  find  any  admissible  trajectory  of  the  system  connecting  two  positions  of 
multibody  system. 

The  stabilizing  problems  are  addressed  by  several  groups  of  methods: 

•  There  were  developed  methods  that  exactly  linearized  the  nonlinear  system  and  thus  enable  after  the 
linearizing  transformation  to  apply  standard  control  methods  for  linear  systems. 

•  Another  approach  is  to  propose  a  control  law  based  on  some  insight  into  the  system  and  then  to  carry 
out  the  synthesis  of  control  parameters  for  the  nonlinear  plant  as  control  gain  optimization  by  the 
technique  of  multiobjective  parameter  optimization  (MOPO). 

•  Very  promising  method  is  to  rewrite  the  nonlinear  system  into  the  form  of  linear  system  and  then  to 
apply  the  standard  control  methods  for  linear  systems  however  for  position  (state)  dependent  system.  It 
is  another  way  for  transforming  the  nonlinear  system  into  linear-like  one. 

The  problem  of  constructing  suitable  trajectory  is  formulated 

•  either  directly  as  the  optimal  control  problem  that  is  generally  not  quite  easy  to  be  solved 

•  or  in  specifically  difficult  cases  of  under-actuated  systems  as  time  planning  problem  that  requires  first 
to  construct  the  missing  control  actions  in  order  to  modify  the  system  into  equal-actuated  one. 

3.  Simple  Demonstrational  Example 

The  above  stated  problems  and  further  described  solution  methods  can  be  demonstrated  on  the  following  simple 
problem.  Despite  its  simplicity  this  example  includes  all  serious  problem  of  control  of  multibody  systems. 

The  exemplary  multibody  system  (Fig.  1)  consists  of  two  bodies  connected  by  revolute  joints  in  plane. 
It  has  two  DOFs.  The  first  joint  is  always  actuated  by  controlled  action  M,.  The  second  joint  can  be  or  can  be  not 
actuated  by  the  torque  M2.  If  it  is  actuated  then  the  system  is  equal-actuated  and  methods  for  exact  linearization 
can  be  applied.  It  is  a  case  of  rigid  planar  robot  manipulator.  If  the  second  joint  is  not  actuated  then  the  system  is 
under-actuated  and  there  are  problems  of  its  control.  If  this  not-actuated  joint  is  equipped  with  spring  and 
damper  then  it  is  a  model  of  flexible  robotic  arm.  If  there  is  no  spring  in  this  not-actuated  joint  then  it  is  a  model 
of  mechatronic  toy  with  different  control  challenges. 

The  multibody  system  can  be  described  by  the  independent  coordinates  (e.g.  <p,  and  (p2)  or  by  the 
dependent  coordinates  (e.g.  the  cartesian  coordinates  of  centre  of  mass  and  angles  of  links  with  respect  to  the 
frame  or  natural  Cartesian  coordinates  of  ends  of  links).  According  to  that  the  control  is  formulated  as  traditional 
control  of  ODE  or  control  of  DAE. 


Figure  I.  Example  of  simple  multibody  system  with  different  control  problems 

4.  Description  of  Nonlinear  Multibody  Systems 

The  (nonlinear)  multibody  systems  including  the  control  action  are  generally  described  by  Lagrange  equations  of 
mixed  type  (e.g.  [1]) 

M(S)^-*rX  =  Q(S,^)  +  m^;u  (1) 

at  at  at 

F<s’f)=“  ® 

where  s  are  the  coordinates  describing  the  multibody  system,  u  the  vector  of  input  control  variables,  M  is  the 
mass  matrix,  Q  are  the  generalized  forces,  F  are  the  kinematic  (holonomic  or  nonholonomic)  constraints,  <D  is 
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the  Jacobian  corresponding  to  the  kinematic  constraints,  X  are  the  Lagrange  multipliers,  u  the  control  inputs 
(forces)  acting  through  transmissions  T.  This  fact  that  the  general  description  of  multibody  systems  uses 
differential-algebraic  equations  (DAE)  is  one  of  difficult  problem  of  control  synthesis  for  multibody  systems. 

These  equations  of  motion  for  the  purposes  of  control  must  be  often  transformed  into  the  state  space 
description.  There  are  two  possible  ways  how  to  do  it.  The  first  approach  preserves  the  same  variables  s  from 
original  description  and  only  eliminates  the  Lagrange  multipliers  X.  The  kinematic  constraints  F  in  (2)  are  twice 
differentiated  with  respect  to  time 


$> 


d2 s  _  _  ds »  ds 
dt 2  dt  s  dt 


(3) 


where  subscript  s  means  partial  differentiation  with  respect  to  the  coordinates  s.  The  accelerations  are  expressed 
from  the  equations  of  motion  (1)  by  multiplying  it  by  the  inverse  of  mass  matrix  M  and  they  are  substituted  into 
(3).  The  equations  for  the  Lagrange  multipliers  are  thus  derived.  Solving  for  them  and  substituting  back  it  is 
obtained  the  formulation  of  equations  of  motion  of  multibody  system  (1)  in  seemingly  ordinary  differential 
equations  (ODE)  only. 


—  =  M'1  (I  -  7  (#  M“'4>  r)~'  $  M_,)(Q  +  Tu)  -  r(4>  M  '<t> 7 )"’  ($  ^-)s  ~  (4) 

dt 2  dt  dt 

Hence  the  state  space  description  with  state  vector  [s,  d/dt  s]  in  dependent  coordinates  s  can  be  obtained. 
However,  in  such  case  the  resulted  equations  are  after  linearization  not  controllable.  It  follows  from  the  fact  that 
in  such  case  the  dependent  coordinates  on  the  level  of  acceleration  are  related  by  the  quadratic  terms  in  velocities 
as  follows  from  the  second  derivatives  of  kinematic  constraints  F  in  (3).  Such  equations  are  after  linearization 
not  controllable  in  usual  positions  with  zero  velocities.  Nevertheless  this  simple  formulation  is  sometimes  useful, 
e.g.  for  optimal  control  in  section  8. 

The  other  approach  is  based  on  the  description  of  multibody  systems  in  independent  coordinates  q.  The 
coordinates  must  be  independent,  e.g.  the  independent  coordinates  q  are  selected  (constructed)  from  s  generally 


d2  _  d2  d  d 
— rS  =  R — -q  +  — R  — 
dt  dt2  dt  dt 


q 


(5) 


Substituting  from  (5)  into  the  first  time  derivative  of  the  kinematic  constraint  it  is  found  out  that  this  matrix  R  is 
the  null  space  of  the  Jacobian 


<j>r  =  o 


(6) 


Thus  multiplying  the  equations  of  motion  (1)  by  RT  eliminates  again  the  Lagrange  multipliers.  Then  using  the 
state  vector  x=[q,  dq/dt]  the  equations  of  motion  can  be  transformed  into  the  state  space  model 


q  =  (R7MR)_1(Rrg-RrMRq)  +  (RrMR)  *RrTu 


The  theory  of  multibody  systems  and  the  solution  of  corresponding  DAE  describes  several  methods  for  deriving 
and  obtaining  the  null  space  matrix  R  (e.g.  [1]). 

Now  the  dynamics  of  multibody  system  can  be  described  in  the  form  of  general  nonlinear  system  in 
state  space  description 
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~-=f(x)  +  g(x)u 
at 


(8) 


where  x(nxl)  is  the  state  vector,  u(mxl)  is  the  control  vector  and  generally  f(0)=0.  For  the  purpose  of  control  it 
must  be  stated  which  variables  y  can  be  measured  and  used  as  the  input  to  the  control  system.  It  is  supposed  their 
general  dependence 

y  =  h(x)  (9) 

Thus  there  is  the  output  variable  vector  y(pxl). 

5.  Exact  Feedback  Linearization  of  Nonlinear  Systems 

One  of  the  fundamental  approaches  towards  the  control  of  nonlinear  systems  is  the  exact  feedback  linearization 
[2-5].  Its  idea  is  simple.  Considering  the  system  (8)  it  is  investigated  the  existence  and  the  construction  of  a 
suitable  (static)  state  feedback  control 

u  =  o(x)  +  j8(x)w  (10) 

and  a  transformation  of  variables 


z  =  T(x) 

that  together  transform  the  original  system  (8)  into  a  linear  one 


-  =  Az  +  Bw  <l2) 


The  same  problem  can  be  investigated  for  the  existence  of  a  suitable  dynamic  state  feedback  control 

u  =  o(x,p)  +  /3(x,p)w 

~~  =  0(x)  +  i7(x)u  (13) 

at 

with  a  transformation  of  variables  (11)  that  again  transform  the  original  system  into  a  linear  one  (12).  These 
problems  are  called  input-state  (exact  feedback)  linearization.  And  finally  both  these  problems  can  be 
investigated  for  output  feedback  where  instead  of  state  variables  x  in  feedbacks  (10)  or  (13)  there  are  used  only 
output  variables  y  (9).  Then  these  problems  are  called  input-output  (exact  feedback)  linearization. 

Then  after  transforming  the  original  system  into  the  equivalent  linear  one  (12)  there  are  applied  the 

control  techniques  for  linear  systems  like  pole  placement,  LQR  etc. 

5.1  INPUT-OUTPUT  EXACT  FEEDBACK  LINEARIZATION 

The  solution  of  the  problem  of  input-output  exact  feedback  linearization  is  simpler.  The  construction  of  possible 
linearizing  feedback  for  the  system  (8)-(9)  is  the  recursive  application  of  the  time  differentiation  rule 

y(°  =  dx  (f(X)  +  8(X)  U)  =  f‘ (x)  +  g' (x)  u  =  L<h  +  Lshu  =def  z,  =def  z2 
,,  n  dz  <14) 

y  +  =  ^f(f(X)  +  8(X)  U)  =  f-  (x)  +  (x)  U  *.♦.  =der 

There  is  supposed  besides  necessary  smoothness  that  gi=0  for  i=l,...,r-l  and  gr*0  enabling  to  express 
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(15) 


fr(x)  +  gr(x)u  =  w 
u  w-fr(x) 
gr(X) 

and  this  leads  to 

y(r)  =  w  (16) 

This  means  that  the  original  system  is  first  transformed  into  the  Brunovsky  canonical  form  (14)  and  then  into  the 
Frobenius  canonical  form  (16).  These  canonical  forms  prove  the  controllability  of  the  system  and  enable  to 
stabilize  the  system  easily  by  pole  placement. 

The  transformation  (1 1)  is 

z  =  T(x)  =  [(h(x))r ,  (Lf  h(x))r (Lf_1h(x))r  ]r  (17) 

Here  and  in  previous  expressions  there  is  used  the  formalism  of  Lie  algebra 

Lf  h(x)  =  ^f(x),  4+1h(x)  =  Zf4h(x) 

5x  (18) 

[f,gl(x)  =  ^f(x)-  —  g(x),  ad  fg(x)  =  g(x),  ad]{g(x)  =  [f,g](x),  ^+1g(x)  =  [f,atf'g](x) 

dx  dx 

It  can  happen  and  it  happens  that  r<n.  In  that  case  there  is  another  dynamics  in  the  system  (8)  besides  (16).  It  is 
so  called  zero  dynamics  that  is  expressed  from  the  original  system  stating  the  condition  y=y(1)=...=y(r)=0.  The 
zero  dynamics  is  not  influenced  by  the  transformation  (17)  and  the  control  (15).  The  stability  of  this  zero 
dynamics  is  decisive  for  the  stabilizability  of  the  whole  system  just  by  stabilizing  the  input-output  dynamics  (16) 
by  the  feedback  (15)  and  pole  placement. 

5.2  INPUT-STATE  EXACT  FEEDBACK  LINEARIZATION 

This  is  the  problem  whether  there  exists  such  function  y=h(x)  for  which  the  input-output  exact  feedback 
linearization  gives  r=n.  This  means  that  the  system  is  completely  linearized  and  there  is  no  zero  dynamics  with 
the  danger  of  destabilizing  the  system.  There  have  been  proved  the  necessary  and  sufficient  condition  for  its 
existence.  This  is  the  full  rank  (equal  n)  of  the  vector  field  [g,  adfg,...,adf'"1g]  and  the  set  [g,  ad,g,...,adfn'  g]  is 
involutive  (this  means  that  if  two  vectors  ki  and  k2  are  from  this  set  then  [ki,k2]  is  also  from  this  set).  However, 
the  construction  of  such  h(x)  is  not  so  easy  as  the  computation  of  the  input-output  exact  feedback  linearization 
(14). 

In  all  these  derivations  it  is  supposed  that  the  dimension  of  y  is  equal  to  the  dimension  of  u  and  w.  This 
is  certainly  often  violated  that  prevents  to  apply  this  method  for  the  control  of  under-actuated  systems. 

5.3  DYNAMIC  STATE  EXACT  FEEDBACK  LINEARIZATION 

There  has  been  proved  that  the  existence  of  dynamic  exact  feedback  linearization  is  equivalent  to  the  special 
property  of  the  system  (8)-(9)  called  flatness  [6-8].  A  dynamic  system  is  flat  if  the  system  (8)-(9)  can  be 
transformed  into  the  relation  between  states  and  outputs  and  inputs  and  outputs  in  the  form 

x  =  ®(y,y®,...,y<“))  0») 

« =  'f(y.y<l>.---.y<“>.yw*,>)  <20> 

The  equation  (19)  is  inverted  and  substituted  into  (20)  together  with  excessive  derivatives  of  output  variables  y 
that  are  replaced  by  new  subsystems  of  the  form  (16).  This  approach  enable  decide  what  kind  of  trajectories  are 

admissible  for  the  control  of  the  investigated  system. 

Again  in  all  these  derivations  it  is  supposed  that  the  dimension  of  y  is  equal  to  the  dimension  of  u  and 
w.  This  is  also  violated  for  corresponding  under-actuated  systems  (e.g.  inverse  pendulum).  Thus  only  certain 
class  of  under-actuated  systems  can  be  controlled  by  this  approach  (e.g.  crane  with  control  of  the  cable  length  is 
flat  [8-9],  but  crane  without  control  of  the  cable  length  is  not  flat). 
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5.4  EXACT  FEEDBACK  LINEARIZATION  OF  DAE  SYSTEMS 

Interesting  problem  is  the  way  of  application  of  exact  feedback  linearization  to  DAE  systems.  The  input-output 
exact  feedback  linearization  can  be  applied  immediately  after  elimination  the  Lagrange  multipliers  (4).  One 
natural  condition  is  that  the  output  variables  (9)  must  be  selected  as  independent  from  the  point  of  view  of 
constraints  (2).  Therefore  it  is  important  to  consider  the  choice  of  outputs  based  on  the  DOFs  of  the  multibody 
system.  However,  the  checking  of  condition  for  existence  of  input-state  exact  feedback  linearization  must  be 
based  on  independent  coordinates  otherwise  the  transformation  can  loos  full  rank. 

Another  problem  is  what  is  the  influence  of  exact  feedback  linearization  constructed  for  independent 
coordinates  on  the  remaining  redundant  ones  [1 1].  The  linearization  of  the  input-output  dynamics  (16)  means  the 
establishment  of  superposition  for  nonlinear  system.  If  two  controls  w,  and  w2  cause  two  motions  yj  and  y2  of 
the  multibody  system  described  in  independent  variables  then  its  linear  combination  aw,  +  pw2  leads  to  the 
motion  ay,  +  Py2.  This  is  not  valid  for  the  dependent  output  variables  yd  because  the  constraint  (2)  is  usually 
nonlinear 


F(y,yrf)  =  0,  yrf=F'(y),  F  !(oy,  +/?y2)*aF",(y1)  +  )0F  ’(y2)  (21) 

Nevertheless,  if  the  linear  combination  ay,  +  Py2  =ydes  moves  to  the  desired  position  ydes  then  also  the  motion  of 
dependent  variables  yd  ends  in  the  corresponding  desired  position  yd,  des  as  follows  from  (21).  This  fact  is 
important  for  determining  the  suitable  admissible  (suboptimal)  trajectories  (e.g.  extension  of  IT 01  for  DAE  in 

tH]). 

6.  Multiobjective  Parameter  Optimization 

This  method  of  control  synthesis  is  the  least  restrictive  one  regarding  the  requirement  on  the  description  of 
nonlinear  (multibody)  system  and  the  form  of  control  law.  However,  the  strength  of  claims  about  the  properties 
of  the  synthetized  control  is  relatively  low.  The  synthesis  procedure  is  following: 

The  Multi-Objective  Parameter  Optimization  (MOPO)  [12]  is  based  on  the  design-by-simulaton.  There 
is  available  the  nonlinear  simulation  model  of  the  controlled  plant  including  the  control  law,  the  performance 
index  usually  in  the  form  of  integral  performance  index  or  maximum  value  and  selected  set  of  considered 
excitations.  The  control  law  is  described  in  parametric  form  and  its  parameters  are  determined  by  the  numerical 
optimization  of  the  performance  index  evaluated  by  the  simulation  response  of  the  plant  to  the  considered 
excitations.  Thus,  by  means  of  the  MOPO  approach  the  nonlinear  models  and  models,  which  cannot  be 
analytically  treated,  can  be  used.  This  approach  enables  not  only  to  find  parameters  of  nonlinear  control  of 
nonlinear  plant,  but  it  allows  one  also  to  find  a  satisfactory  compromise  among  the  performance  criteria  despite 
the  fact  that  they  conflict  with  each  other.  The  MOPO  approach  is  based  on  a  search  in  the  parameter  space 
(Pareto  optimality)  by  model  simulation. 

“Free  system  parameters”,  the  tuning  parameters,  e.g.  control  coefficients,  mass  properties  or 
installation  positions,  are  varied  within  their  given  limits  until  an  “optimal  compromise”  is  found.  In  doing  so  the 
performance  criteria  (also  called  objective  functions)  C  are  weighted  by  user-defined  weighting  factors,  the 
design  parameters  d  >  C s{art .  The  optimization  strategy  is  to  minimize  all  weighted  criteria  Ci  (p)  /  d:  (p)  in 
such  a  way  that  the  currently  worst  criterion  with  the  maximal  value  will  be  reduced:  optimization  tries  to 
decrease  the  weighted  criterion  C(  ( p)/  d  t  (p)  — >  0.  The  tuning  parameters  p  are  determined  by  solving  a 
minmax-optimization  problem  with  constraints  and  parameter  restrictions 

a  =  mirip (max.  c(  / d;)  (22) 

c,{p)  <  dt  for  i  €  T  (23) 

Pk^Pk^  P+k  (24) 

The  performance  criteria  (objective  functions)  may  be  free  to  be  optimized  or  may  be  partially  limited  by  a  set 
y  of  performance  constraints,  e.g.  mechanical,  hydraulic  or  electronic  restrictions  like  power,  pressure,  current 
and  voltage.  The  weighting  factors  or  design  parameters  enable  the  user  to  adapt  the  criteria  to  adequate  sizes 
and  to  determine  the  direction  of  optimization  process  by  weighting  some  criteria  more  important 

(c;(p)/^(p)  —  l),  others  less  important  (cy  (p)/  d j  (p)  <  {fi)I  dt  (p)).  The  parameter  optimization  is 
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finished,  when  the  maximum  of  all  weighted  criteria  cannot  be  further  decreased.  The  result  is  a  point  on  the 
Pareto-optimal  boundary  (Fig.  2). 

Example  of  application  of  MOPO  synthesis  for  vehicle  suspensions  is  in  [13]. 


7.  Nonlinear  Linearization  of  Nonlinear  Systems 

This  is  another  way  of  transforming  a  nonlinear  system  into  a  linear  form  where  methods  of  linear 
control  can  be  applied  [14-19].  The  dynamics  of  the  nonlinear  system  is  described  by  the  equations  (8).  The 
multibody  system  must  be  described  by  independent  coordinates,  otherwise  further  described  decomposed 
system  is  uncontrollable.  The  quadratic  performance  index  of  the  control  which  is  to  be  synthesized  is  the 
infinite  horizon  control 


J  =  J(xrQx  +  urRu)dt 
0 

If  there  exists  the  decomposition  of  the  system  dynamics 


f(x)  =  A(x)x 


(25) 


(26) 


and  if  the  following  assumptions  [14]  are  valid 

•  The  matrixes  Q  and  R  are  positive  definite. 

•  The  matrixes  A  and  g  are  analytic  valued  functions. 

•  There  exists  the  control  function  u(t)  and  corresponding  state  trajectory  x(t)  for  te<0,co>  which  satisfy  the 
system  dynamics  (8)  and  the  performance  index  (25)  is  finite. 

•  The  pair  of  marixes  (A(x),g(x))  is  controllable  and  stabilizable  for  each  x  in  the  linear  system  sense,  i.e. 


rank[  g(x),  A(x)g(x), . . . ,  A"”1  (x)g(x)]  =  n  (27) 

•  The  state  vector  x  is  fully  measured, 
then  there  exists  the  control 

U  =  -K(x)x  (28) 

which  minimizes  the  performance  index  (25).  However,  it  has  been  shown  that  this  control  is  only  suboptimal. 
The  nonlinear  gain  matrix  K(x)  is  determined  as 

K(x)  =  R_1gr(x)P(x)  (29) 


where  P(x)  is  the  solution  of  the  Riccatti  equations 
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Ar(x)P(x)  +  P(x)A(x)  +  Q  -  P(x)g(x)R-'g7  (x)P(x)  =  0  (30) 

This  control  approach  is  called  Nonlinear  Quadratic  Regulator  (NQR)  [17]  or  State  Dependent  Riccatti 
Equation  (SDRE)  control  [15,  16], 

The  key  problem  is  the  computation  of  the  decomposition  A(x).  There  have  been  derived  some 
formulas  for  the  computation  of  this  decomposition,  like  [36] 


A(x)  =  i 


df 


dx 


dX 


x=A  x 


(31) 


But  the  computation  of  this  formula  for  the  multibody  systems  is  very  difficult  because  it  requires  the  symbolic 
manipulation  with  the  equations  of  motion  which  might  be  very  large  and  complex  and  might  include  rational 
and  trigonometric  functions.  Therefore  it  is  not  realistic  to  suppose  to  compute  (31)  for  multibody  systems. 

Therefore  there  have  been  developed  efficient  algorithms  [17]  for  computation  of  this  decomposition 
that  moreover  enables  to  use  the  non-uniqueness  of  the  decomposition  (26)  for  control  synthesis.  The  simplest 
procedure  among  them  is  following.  Its  idea  is  based  on  the  following  decomposition  described  for  scalar 
function  f  of  three  variables  xb  x2,  x3 


f(xx,x2,x3)=  /(*l>*2,*3)-/(0>*2>*3) 


X,  + 


,  f(0,x2,x2)-f(0,0,x2) 

4“  .  Xy  4” 

*2 

,  /(0,0,Xj)-/(0,0,0) 

4"  X-> 


(32) 


This  decomposition  must  certainly  solve  the  division  by  zero  and  it  is  dependent  on  the  order  of  variables.  The 
division  by  zero  is  equal  according  to  l’Hospital  rule  in  the  limit  to  the  corresponding  derivative  which  for 
smooth  functions  exists  and  can  be  numerically  computed  by  division  for  magnitudes  of  numerical  accuracy  of 
the  computer. 

The  computation  of  this  decomposition  is  not  unique.  It  depends  on  the  order  of  variables  and  besides 
that  there  are  some  free  parameters  for  decomposition  parametrization  [17],  The  influence  of  this  ambiguity  can 
be  described  and  investigated  by  the  recursive  decomposition  (32)  applied  to  each  addend  of  the  previous 
decomposition  step.  There  are  2”  such  addends  at  the  end  for  n  variables  which  is  very  natural  for  polynomial 
functions  f.  However,  the  problem  is  that  any  addend  f,  in  any  level  of  decomposition  can  be  split  into  convex 
sum  fjA.+fi(l-X)  where  X  can  be  any  function.  This  makes  the  decomposition  fully  ambiguitious.  The  level  of 
recursive  decomposition  and-or  the  free  functions  X  can  be  selected  in  order  to  improve  controllability  of 
decomposed  system  (8)  with  (26). 

The  main  problem  with  NQR  is  that  first  it  is  not  the  optimum  control  of  general  nonlinear  system  as  it 
has  been  shown  in  [18]  and  second  there  is  still  missing  a  proof  of  global  stability  of  the  control  law  (28)  despite 
partial  results  [19],  There  has  not  been  found  any  case  of  unstable  NQR  control  but  general  proof  is  missing.  The 
practical  experience  is  excellent  and  the  stability  can  be  checked  for  individual  cases  using  the  computed 
solution  of  the  Riccatti  equation  (30).  The  Lyapunov  function  V  is  proposed  as 


V  =xrP(x)x  (33) 

It  is  positive  definite  according  to  the  properties  of  the  solution  of  Riccatti  equation  and  the  negativeness  of  its 
time  derivative  can  be  checked  similarly  in  the  same  grid  as  the  computed  values  of  the  gain  K(x)  deriving  into 

=  ~xF(Q  +  P(x)g(x)R~’gr(x)P(x)  -  ~^(A(x)  -  g(x)K(x))x)  x  <  0  (34) 

The  first  two  terms  are  proving  stability  and  the  third  term  is  usually  small. 

An  important  practical  issue  of  NQR  is  the  implementation  of  the  synthetized  control  law.  One 
approach  can  be  the  real-time  computation  of  Riccatti  equation  and  the  whole  control.  It  is  certainly  very 

254 


demanding  of  computational  power  but  for  some  small  systems  reasonable.  The  other  approach  is  based 
generally  on  the  look-up  tables.  It  means  that  the  solutions  of  NQR  control  are  computed  for  some  values  of 
states  off-line  and  for  the  on-line  application  the  pre-computed  gains  are  either  retrieved  or  interpolated.  Such 
approaches  were  already  used  for  gain  scheduling  approaches.  The  problem  is  certainly  the  efficient  choice  of 
suitable  states  for  off-line  computation  and  the  on-line  interpolation  between  them.  This  approach  is  applicable 
even  for  large  multibody  systems. 

Another  important  advantage  of  NQR  approach  is  that  the  control  can  be  extended  into  incorporating 
different  limitations  of  admissible  control  sets  (e.g.  asymmetric  interval  of  control  variable  for  semi-active 
systems  [20]). 

This  approach  of  NQR  is  applicable  to  all  under-actuated  (certainly  equal-actuated)  systems  that  satisfy 
the  condition  that  the  linearized  system  about  the  equilibrium  x=0  is  controllable.  Even  this  condition  is  violated 
for  important  classes  of  under-actuated  systems  (e.g.  some  nonholonomic  multibody  systems).  For  this  class  of 
multibody  systems  the  control  is  very  difficult.  The  stabilizing  control  were  developed  for  such  systems  having 
f(x)=0,  but  for  general  systems  with  f(x)*0  it  is  still  an  open  problem. 

8.  Optimal  Control  of  Multibody  Systems 

The  optimal  control  in  the  formulation  of  Pontryagin  principle  of  maximum  is  applied  for  nonlinear  multibody 
systems  especially  for  the  purpose  of  trajectory  synthesis.  The  traditional  formulation  of  Pontryagin  principle  of 
maximum  for  ODE  of  the  system  (8)  is  well  known.  However,  its  formulation  for  DAE  systems  is  quite  new 
problem.  There  were  several  approaches  to  extend  the  maximum  principle  straightforward  from  ODE  to  DAE 
systems,  however  with  incorrect  results.  Only  recently  [21]  it  has  succeeded  to  derive  the  correct  proven 
extension.  It  is  based  on  the  idea  that  the  DAE  system  (l)-(2)  is  transformed  into  the  ODE  system  (4)  just  for  the 
formulation  of  optimality  conditions.  In  other  words  it  means  that  the  optimality  conditions  raised  on  the 
Hamiltonian  must  not  involve  the  Lagrange  multipliers  X.  The  optimality  conditions  are  formulated  using  the 
equivalent  ODE  problem,  but  the  problem  solution  is  done  within  DAE  problem.  Thus  the  efficient  and/or 
convenient  formulation  of  multibody  model  is  maintained  and  only  the  optimality  conditions  are  formulated 
based  on  ODE. 


9.  Cyclic  Control 

The  control,  but  just  the  synthesis  of  suitable  admissible  trajectory  for  under-actuated  systems  that  are  not  flat, 
being  linearized  around  equilibrium  are  loosing  controllability  or  simply  the  system  states  go  over  the  boundary 
of  singularities,  is  a  difficult  problem.  Then  there  is  possible  the  approach  of  cyclic  or  invariant  control  [22]. 

Let  solve  the  equation  (15)  for  input  variables  u  of  the  system  (8)  in  the  number  equal  to  the  number  of 
output  variables  y  in  (9).  The  corresponding  subsystems  i  and  j  will  have  the  form  (16)  and  (14) 


yi,)  =  w 


yf  =  hrj  (X)  +  Sj ,,  (*)  U  =  f j,rj  00  +  gM  (X) 


w-f,.,(x) 

g,,(x) 


(35) 


The  new  input  variables  w  can  be  divided  into  two  parts  —  arbitrary  Wa  and  cyclic  (invariant)  W|  control 

W  =  W^+W7  (36) 

The  arbitrary  control  is  used  for  the  control  of  subsystem  i  and  the  cyclic  (invariant)  control  is  used  for  the 
control  of  those  subsystems  j  that  cannot  be  linearized  as  the  subsystem  i.  The  invariant  control  is  constructed 
based  on  periodic  functions  {wI>m}  with  period  T  in  such  way  that  it  does  not  influence  the  state  of  subsystem  i  in 
times  kT 


W/  =YakmWI,m 

m 

T  T 

J wJ>mdt  =  0,  \\wlmdtdt  =  0, J. ..  ...<*  =  0 

0  0 


(37) 
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By  this  way  there  are  constructed  new  control  variables  Wi  that  influence  only  other  subsystems  than  the 
subsystem  i.  Such  control  can  be  used  for  the  path  across  the  boundary  of  singularity  etc.  This  control  can  be 
then  combined  with  NQR  control  around  the  vicinity  of  equilibrium  iff  the  system  is  controllable  after 
linearization. 

10.  Conclusions 


There  have  been  developed  many  very  powerful  control  approaches  for  general  nonlinear  systems.  A  special 
case  are  nonlinear  multibody  systems.  Despite  many  new  control  methods  there  still  remain  open  problems  (e.g. 
stabilization  of  nonholonomic  systems  with  offset).  Further  there  are  specific  problems  of  application  of  control 
methods  for  multibody  systems  if  they  are  described  by  redundant  coordinates  and  DAE. 
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Abstract:  In  the  present  article  a  numerical  approach  for  modeling  impact  and  unilateral  contact  constraints  of  multibody  systems  is  presented. 
The  discontinuous  Coulomb  friction  is  taken  into  account.  The  explicit  form  dynamic  equations  and  impulse  -  momentum  equations  without 
kinematics  constraints  are  the  basis  of  the  dynamic  model.  Generalized  coordinates  and  impulses  are  parameters  of  the  dynamic  equations.  The 
contact  effects:  stiction,  sliding,  the  transition  sliding-sticlion-sliding  are  included  in  the  simulation.  An  approach  of  analysis  of  the  contact  point 
velocities  in  the  tangential  plane,  as  well  as,  of  the  normal  and  tangential  impulses  is  applied  for  numerical  estimation  of  the  motion  in  the  contact 
points  and  of  the  whole  system.  Rigid  and  flexible  multibody  systems  are  considered.  For  the  rigid  bodies,  the  contact  laws  of  Newton  and 
Poisson  are  applied.  It  is  pointed  out  that,  cither  for  rigid  or  for  flexible  multibody  systems,  the  theory  of  the  coefficient  of  restitution  docs  not 
present  reliable  results.  In  the  treatment  a  novel  approach  is  suggested  in  which,  as  a  result  of  existence  of  contact,  transformation  of  the  dynamic 
equations  is  implemented.  The  normal  impulses  and/or  the  normal  reactions  become  parameters  of  the  linear  equation  system.  Simultaneous 
contact  (impact  and  surface  contact)  in  multiple  points  is  discussed  and,  in  this  case,  a  numerical  algorithm  for  system  motion  simulation  is 
presented.  Several  examples  of  impact  of  rigid  and  flexible  mechanical  systems  and  existence  of  unilateral  constraints  are  displayed. 


1.  Introduction 

In  the  treatment  inultibody  systems  arc  considered  mechanical  systems  built  of  rigid  and  flexible  bodies.  The  possible  motions 
are  subject  of  kinematic  and  force  constraints  that  are  imposed  by  joints,  springs,  prescribed  motions  and  etc.  The  main  subject  is 
the  contact  that  occurs  as  a  result  of  the  system  motion  and  is  not  guarantied  by  the  design  scheme.  That  is  contact  as  a  result  of 
impact  and  surface  unilateral  constraints.  The  discontinuous  nature  of  this  motion  makes  the  dynamic  model  and  the  simulation 
procedure  complicated  problem  and  requires  specific  approaches  for  its  solution. 

Mainly  two  approaches  have  been  used  in  the  scientific  literature.  These  are: 

-  classical  approach  of  the  constrained  dynamics  and  analysis  of  the  Lagrange's  multipliers  using  complimentary  conditions 
and  coefficient  of  restitution; 

-  approach  of  estimation  of  the  contact  forces  as  a  result  of  possible  penetration  of  the  contact  surfaces  and  consequential 
integration  of  the  dynamic  equation  using  numerical  methods  and/or  penalty  functions. 

In  the  classical  theory  existence  of  contact  means  additional  kinematic  constraints  [1],  The  inclusion  or  exclusion  of  algebraic 
constraints  that  correspond  to  contact  phenomena  transforms  the  dynamic  equations  where  the  amplitudes  of  the  contact  forces 
are  included.  The  sign  of  the  Lagrange's  multipliers  defines  the  direction  of  the  contact  forces  and,  respectively,  existence  of 
contact  or  separation  of  the  contacting  points.  The  contact  problem  solution  becomes  more  complicated  if  nonlinear  friction  in 
the  tangential  plane  is  assumed.  One  unilateral  constraint  could  have  four  different  states:  separation  of  the  contact;  sliding, 
continuous  stiction;  transition  stiction  -  sliding.  The  stiction  phenomenon  and  possible  transition  stiction  -  sliding  causes 
branching  of  the  calculations  and  requires  additional  transformations  of  the  dynamic  equations.  A  complicated  problem  is  the 
definition  of  the  sliding  direction  after  stiction  in  the  tangential  plane.  This  branching  implies  the  necessity  of  solution  of 
combinatorial  task.  The  aforementioned  problems  are  discussed  in  details  and  successfully  solved  in  a  consequence  of  scientific 
investigations  of  Glocker  and  Pfeiffer  [2,  3],  Seyfferth  and  Pfeiffer  [4]  ],  Wosle  and  Pfeiffer  [5], 

The  distance  at  the  very  beginning  or  end  of  the  contact  defines  the  normal  direction  and  the  tangential  plane  in  the  contact 
points.  During  the  impact  process  it  becomes  zero  and  the  next  stage,  called  compression  phase,  transformation  of  the  kinetic 
energy  of  the  system  into  potential  energy  of  the  elastic  deformations  is  achieved.  The  process  of  restitution  of  the  stored 
potential  energy  into  kinetic  and  separation  of  the  bodies  is  called  restitution  phase.  The  process  of  regeneration  of  kinetic  energy 
is  the  reason  for  experimental  investigations  of  the  so-called  "coefficient  of  restitution".  The  most  frequently  used  definitions  of 
the  coefficient  of  restitution  arc  based  on  (Hunt  and  Grossley  [6]  ,  Brach  [7],  Keller  [8],  Wang  and  Mason  [9]):  the  Newton's 
theory  of  the  ratio  between  the  relative  velocities  of  the  contact  points  after  and  before  the  impact;  the  Poisson's  theory  of  the 
ratio  of  the  impulses  in  the  contact  point  during  the  phases  of  restitution  and  compression. 

The  coefficient  of  restitution  provides  one  step  solution  of  the  velocity  problem  and  is  widely  applied  for  analysis  of  impact. 
The  basic  hypotheses  have  been  used  in  many  treatments.  Glocker  and  Pfeiffer  [10]  presented  a  two-dimensional  impact  model 
based  on  Poisson's  hypothesis  and  Coulomb  friction.  The  problem  of  multiple  impacts  of  multibody  systems  is  regarded  using 
nearly  identical  conditions  during  the  two  impact  phases,  compression  and  restitution.  In  their  recent  book  Pfeiffer  and  Glocker 
[1 1]  developed  this  methodology  in  case  of  impact  of  multibody  systems  with  unilateral  constraints.  Schiehlen  [12]  regarded 
different  approaches  of  multibody  contact  dynamics  and  multi-rate  integration  methods  are  proposed  to  enhance  the  efficiency  of 
the  calculation  procedures.  Lankarani  and  Pereira  [13]  made  a  detailed  review  of  the  studies  concerning  this  topic.  The  authors 
solved  the  rigid  multibody  systems  frictional  impact  and  described  seven  phases  of  possible  motion  of  colliding  bodies  that  arc  to 
be  analyzed  for  estimation  of  the  real  motion. 

In  the  second  approach  of  contact  and  impact  simulation  the  distance  (or  the  gap)  between  the  contact  surfaces  plays 
significant  role.  For  modeling  of  impact  an  approach  is  used  [14,  15]  where  the  contact  points  are  loaded  by  forces.  The 
parameters  of  the  forces  correspond  to  the  stiffness  properties  of  the  body  materials  and  shapes  and  their  values  arc  calculated 
using  linearized  data  obtained  by  contact  Hertz’  theory  [16],  The  dynamic  equations  of  motion  arc  then  numerically  integrated. 
Similar  approach  is  this  of  the  penalty  functions  [17  -  19].  In  [19]  the  convergence  of  the  penalty  function  method  and  the 
reduced  -  integration  penalty  methods  are  discussed. 

In  the  article  a  numerical  algorithm  for  modeling  of  impact  of  rigid  and  flexible  multibody  systems  taking  into  account  the 
nonlinear  Coulomb  friction  is  suggested.  A  modified  dynamic  model  using  Lagrange’s  equations  is  suggested.  The  possible 
motions  along  the  normal  directions  of  the  contact  point  tangential  planes  are  considered  coordinates  and  parameters  in  the 
dynamic  equations.  Transformation  of  the  dynamic  equations  is  implemented,  where  the  motions  appear  as  parameters  if  no 
contact  exists  or,  in  case  of  contact,  the  reaction  forces  are  parameters  of  the  dynamic  equations.  Using  this  approach  the  size  and 


the  number  of  the  parameters  is  constant.  The  parameters  of  multiple  contact  points  (unilateral  contact  an  impact  points)  arc 
included  in  the  dynamic  equations. 

The  algorithm  is  consequently  applied,  if  rigid  bodies  arc  considered,  to  the  two  phases  of  the  impact  -  compression  and 
restitution.  In  every  phase  the  possible  events  sliding,  reverse  sliding,  stiction  and  sliding-stiction  arc  analyzed  satisfying  the 
impulse-momentum  equations.  The  algorithm  is  developed  in  case  of  hypotheses  of  Newton  and  Poisson  for  the  coefficient  of 
restitution.  A  new  definition  for  “dominant  tangential  jump”  is  developed  for  analysis  of  the  stick-slip  process  in  the  tangential 
plane  at  the  time  of  impact.  The  same  numerical  procedure  is  applied  in  ease  of  flexible  systems  discretized  using  finite  elements 
in  relative  coordinates.  The  jumps  of  the  velocities  arc  obtained  as  a  result  of  vanishing  of  the  normal  coordinates  between  the 
colliding  nodes.  The  resulting  global  deflections  of  the  flexible  system  arc  obtained  integrating  the  dynamic  equations  with  the 
initial  velocities  so  obtained.  The  reaction  forces  in  the  contact  points  arc  calculated.  The  numerical  algorithm  is  analyzed  solving 
several  examples  of  rigid  and  flexible  multibody  systems  in  ease  of  multiple  contact  and  impact  of  flexible  elements  and  nodes. 

2.  Theoretical  Background 


The  theoretical  background  of  the  multibody  system  dynamics  is  well  developed  and  studied  The  analytical  form  of  a  multibody 
system  dynamic  equations  with  kinematic  constraints,  as  a  common,  arc  presented  by  second  order  Differential  Algebraic 
Equations  (DAE) 

M  Q=g{q,q)  (!) 

4>(Q)=0m  (2) 

with  respect  to  n  x  1  matrix  -  column  Q  of  the  second  time  derivatives  of  all  coordinates  of  motion  Q  =  [<y,  q2  •••  qn  ] 

For  a  common  ease  the  analytical  solution  cannot  be  provided.  The  numerical  solution  requires  discretization  of  the  equations 
(1,2).  Using  the  Lagrange  s  equations  and  after  transformations  one  obtains  the  linear  (n+ni)  x(rt+ni)  equation  system  with 
respect  to  the  unknown  Q  and  coefficient  of  Lagrange,  m  sized  matrix  -  column  A  ,  i.  c.: 

mq-0q-a  =  g(q,q) 

0q(Q)  Q+<pq(Q)  Q  =  onl 

that  provides  solution  of  the  initial  value  problem  (with  given  Q  and  Q  ).  The  solution  of  the  DAE  (3,  4)  should  also  satisfy  the 
discretized  position  constraint  equations,  as  well  as,  their  first  time  derivatives,  i.  e.: 

0(0)  =  0„  i  (5) 

0Q(0)Q  =  Om  (6) 

111  equations  (1  -  6)  M  is  n*n  mass-matrix;  G  is  n  sized  matrix  -  column  of  the  applied  and  velocity  dependent  inertia  forces; 
-  _  0<J> 

9Q  ~  is  m*n  matrix  of  the  partial  derivatives  of  the  constraint  equations;  0m  is  m  sized  zero  matrix-column  (O'1  and 

0"„  arc  n  sized  row  zero  matrix  and  zero  matrix,  respectively). 

For  constraint  dynamics  the  IME  in  ease  of  impact  in  a  point  areas  follows  [1]: 


(3) 

(4) 


M  AQ~Qq  I x  =  d' 


dQ 


-l. 


&qAQ=  0m 

SQ  ■  &Q  =  -(l  +  e)  Jg  Q(~} 


(7) 

(8) 
(9) 


where  s  =  s(Q)  is  the  distance  between  the  colliding  surfaces  at  the  time  of  impact;  sq  -  —  ;  A Q  =  Q(+)-Q(  J  is  the 

dQ 


jump  of  the  velocities  after  (superscript  +)  and  before  (-)  the  impact;  I x  is  tn  sized  matrix  —  column  of  the  impulses  caused  by 
the  constraints;  and  e  is  the  coefficient  of  restitution  for  the  specific  body  shapes  and  materials  in  the  points  of  impact.  Here  the 
coefficient  of  restitution  is  defined  according  to  the  Newton’s  hypothesis.  As  one  could  see  from  equations  (7  -  9)  the  existence 
of  impact  adds  to  equations  (7,  8)  one  constraint  (9)  and  one  parameter  -  the  impulse  Is  in  the  point  of  impact.  So,  the  IME 

(7  -  9)  are  n+m+1  linear  equation  system  with  respect  to  n+m+l  unknown  parameters  -  velocities  jumps  A Q  ,  impulses  of  the 
constraints  I x  and  impulse  in  the  contact  point  Is  , 

The  Poisson  s  hypothesis  could  be  applied  for  the  restitution  phase  only,  calculating  first  the  impulse  during  the  compression 
phase  applying  the  Newton’s  hypothesis  with  coefficient  of  restitution  e  =  0.  For  the  restitution  phase  the  impulse  !s  in  equation 

(7)  is  known  parameter,  i.  c.,  Is  =  lrs  -e-  lcs  ,  since  lcs  is  computed  at  the  compression  stage.  The  solution  for  the  velocity 

jumps  A Q  -  Q(+)  and  the  impulses  of  the  constraints  at  the  restitution  phase  are  obtained  solving  the  linear  system  of 
equations  (7,  8). 
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3.  Kinematics  of  the  Contact 


In  Fig.  1  a  multibody  system  is  shown  when  one  of  its  body  approaches  the  surface  of  another  one  at  the  time  of  possible  contact. 
The  problem  of  contact  point  detection  is  considered  in  many  papers  (Eberhard  and  Jang  [20])  and  is  not  subject  of  this  paper. 
The  both  tangential  planes  in  the  colliding  points,  respectively,  their  normal  directions  coincide.  If  contact  occurs,  as  a  result  of 
active  kinematic  restrictions,  the  motion  along  the  normal  direction  of  the  contact  tangential  plane  vanishes  and  the  number  of  the 
coordinates  decreases  with  one.  If  stiction  occurs  the  restrictions  become  two  more  (in  case  of  three-dimensional  motion)  and, 
respectively,  two  more  coordinates  become  dependent.  The  possible  small  translations  ,  sx  in  the  tangential  plane,  and  s 

along  its  normal  direction,  as  well  as,  the  possible  small  rotations  0T]  ,  ,  6n  along  the  orthogonal  directions  7]  ,  T2  ,  n  arc 

also  presented  in  the  figure.  In  the  article  the  friction  forces  imposed  on  the  possible  rotations  are  not  regarded  and  only  friction 
along  the  translations  and  the  corresponding  reactions  will  be  considered.  Reaction  forces  appear  along  the  normal  direction,  as 
well  as,  along  both  directions  of  the  tangential  plane  in  case  of  stiction.  Friction  forces  appear  in  the  tangential  plane  if  sliding 
occurs.  The  friction  forces  depend  on  the  friction  coefficient  and  the  normal  reaction,  while  their  directions  are  in  the  opposite 
direction  of  the  velocities  in  the  tangential  plane. 

In  Fig.  2  two  bodies  of  a  multi  body  system  at  the  moment  of  incoming  impact  arc  shown.  The  axis  defined  from  the  tangential 
plane  and  the  normal  direction  in  the  point  of  contact  arc  shown.  Similarly  of  Fig.  1,  the  three  possible  translations  arc  qt ,  g,+| , 
qi+2  that  obviously  coincide  with  the  translations  s,  sT  ,  sT  ,  respectively.  The  corresponding  impulses  are  /,• , 


Fig  1:  Kinematic  presentation 
of  impact  points  of  a  multi  body  system 


Fig.  2:  Generalized  coordinates  and 
impulses  in  case  of  spatial  impact 


//+!  >  /,+ 2 .  where  /,  corresponds  to  the  normal  impulse  ( /,■  =  1  n  )  while  the  other  are  components  of  the  impulse 
T 

lX  ~  1/i+l  h+i]  in  the  tangential  plane.  In  case  of  sliding  in  the  tangential  plane  the  frictional  impulse  is  along  the  opposite 

direction  of  the  tangential  velocity  vr  =  [<7(+j  q^i  ]  while  its  magnitude  depends  on  the  friction  coefficient  and  the  impulse 

along  the  normal  direction.  The  new  notations  of  these  possible  translations  arc  to  point  out  that  we  include  them  as  elements  of 
matrix  Q  and  the  indexes  show  the  number  of  the  elements.  As  well  as,  the  impulses  in  the  contact  points  arc  stored  in  a  matrix  - 
column  of  the  contact  impulses  I  that  differs  from  the  impulses  1 1  of  the  constraints,  equation  (7).  So,  if  contact  occurs  in  a  point 
or  node  the  possible  translations  along  the  normal  direction  and  in  the  tangential  plane  will  be  stored  in  matrix  Q  consequently,  in 
order,  as  it  was  presented  above.  So  it  is  for  the  impulses  in  the  point  of  contact. 

The  dynamic  equations  (3,  4)  could  be  rewritten  in  matrix  form  as  follows: 

t" 


M  -0r 


0, 


Q 


0„ 


-0Q  Q 


=  f(q,q) 


(10) 


The  kinematic  constraints,  equations  (4  -  6),  are  assumed  invariant.in  numbers  and  forms.  They  do  not  present  the  constraints  as 
a  result  of  possible  contact.  Existence  of  contact  adds  additional  constraints  that,  for  a  single  contact  point  for  which  the 
parameter  q ,•  is  the  motion  along  the  normal  in  the  contact  point,  could  be  expressed  as  follows: 

^m+1  =  <7/  =  ai  =  const 


0 


m+1 


=  <7/  =  0 
1  =  <7/  =  0 


(11) 

(12) 

(13) 


The  partial  derivatives  of  the  additional  constraint  0m+\  is 


dQ 


A  =  [o 

dQ 


0  •••  0  1  0  •••  0]  where  the  place 


of  the  unity  in  this  matrix  -  row  coincides  with  the  place  of  the  corresponding  coordinate  q,  in  matrix  Q.  If  impact  occurs  the 
distance  s  between  the  colliding  points  coincides  with  the  corresponding  coordinate  (motion  along  the  normal  direction)  that,  in 
this  case  is  the  fh  element  of  matrix  Q.  The  partial  derivatives  of  s  are  stored  in  matrix  -  row 
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ds  _  3(/,  r 

— -  — =  1°  o  ...  0  1  0  ...  OJ.  -me  jump  of  (he  velocity  Ay  =  s(+  >-*<->  =  Aqi  (Newton’s  hypothesis)  is 

also  eternal  of' matrix  A Q  .  So,  .he  choice  of  the  possible  motions  in  the  points  of  contact  to  be  elements  of  the  matrix  of  the 
coordma.es  Q  simplifies  s,enifiean.iy  the  expressions  of  the  corresponding  constraints,  as  well  as,  of  their  partial  derivatives. 

4.  Transformation  of  the  Contact  Dynamic  Equations 

f  T 1  r  ..  n  T  r 


M  -< 
<Pn  0 


■0O  \q]J! 
K  W 


,i  _  M  -<Pq  Q 

A,„+|  -  M  — 

0e  0,n  lA 


where  matrix  0Q  is  composed  of  matrix  <PQ  for  which  all  elements  of  row  /  arc  zero;  matrix  M , 


"'1.2 

...  o 

"'1.1+1 

"'l, II 

"'2,2 

...  o 

"'2,1+1 

'"2m 

mi,2 

...  -] 

"'(./■+1 

•••  "'/.,, 

2 

...  o 

"'«,/■+! 

"'«,n 

"'/,  I  mi.  2  •••  -1  miM  •••  rnin  05) 

m»,2  -  0 

18  COmpOSCd  0f  ma,riX  M  f0r  Which  thc diaS°nal  elcmcnt  is  equal  1  and  all  other  elements  of  ,,h  column  arc  0;  for  matrix  Q  , 

-  =  ['?l  ^  A"'+1  *'+1  tllc  element  cjj  is  substituted  by  Am+| .  This  simple  substitution  gives  thc 

possibility,  in  case  of  contact  and  if  thc  conditions  (I  I  -  13)  arc  fulfilled,  thc  dynamic  equations  to  be  solved  directly  for  thc 
accelerations  and  for  the  normal  reaction  A,„+|  in  the  contact  point  using  the  latter  as  a  parameter  instead  of  </, .  So  the  size  of 
t  e  differential  equations  and  the  number  of  the  parameters  are  no.  changed.  The  sign  of  Am+|  defines  the  direction  of  the 

contact  points  follows  and  thc  corresponding  constraint  must  be  excluded  from  thc  DAE  para  '°n  °  thc 

elemernTfmarS  S  *  **  ^  P&M  “  3  ^  ““  *«*  ' 

UT1 


°n 


M  -0Q  \AQ\_\dQ 


'  h  0 n+m 


A?,-(l  +  <l7) 

wl„ch  means  that  wiih  given  cocflicicn,  of  restitution  the  velocity  jump  of  the  C  parameter  M,  is  ealeulated  explicitly  from 
17)  and  could  be  excluded  from  equation  (16).  I,  equation  (16)  /,  is  He  impulse  along  the  normal  dime, ion  that  coincides  with 

the/  coordinate.  Thc  resulting  IME  arc  as  follows: 

M  -<pl  \aq\  \M:' 

£  ..JkJ+kr'-*“ 

In  equation  (1 8)  the  matriecs  and  M  are  the  same  matrices  as  described  above  in  equation  (14. 15);  M,  is  the  f  column  of 
matrix  «.  In  matrix  Ag.  similarly  to  matrix  g,  the  element  is  subsiitnted  b,  /,, 

—  A,/l  Al/2  A^i+l  *"  ^"1  ■  This  selection  of  thc  coordinates  results  in  transformation  of  the  mass 
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that  corresponds  to  the  coordinate  <'.  The  friction  forces  in  the  tangential  plane  are  denoted  FM  ,  Fi+ 2  ■  If  stiction  occurs  the 
values  and  directions  of  the  friction  forces  are  calculated  as  follows: 


1 


'iM+tf+2 


■  Rj  Fi+m  '  Ri  >  m  I>  2 


where  fi  is  the  coefficient  of  friction,  while  with  ,  /ll+2  directional  frictional  coefficients  are  pointed  out.  The 
transformation  of  the  DAE  (14),  respectively  of  matrix  M,  taking  into  account  the  friction  in  the  contact  point  is  as  follows: 


M{id)  = 
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ml2  ••• 
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«i+2.2  •" 

M2+1 

"*<+2.1+1 

mi+2,n 
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mn.M 

•"  mn.n 

where  the  notation  M.(hl)  points  out  that  column  /  of  matrix  M  is  transformed  according  to  the  conditions  for  sliding  in  case  of 
contact  for  i'h  coordinate  (element)  of  Q.  the  modified  matrix  of  the  accelerations  is 

2('.r/)  =  fel  <72  "•  Ri  4  m  •"  ?„]T  (21) 

In  the  modified  matrix  <Pq  -  &Q\is/)  all  the  elements  of  column  i  are  equal  zero. 

If  stiction  occurs  constraints,  in  the  fonn  of  equations  (1 1-13),  arc  imposed  of  the  motions  in  the  tangential  plane,  17, +1  and 
<7 <+2  •  In  this  case  the  modified  matrix  M  is  as  follows: 


K(is')  = 
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while  the  modified  matrix  -  column  of  the  accelerations  is 

Q{‘st)  -  [<7l  <7  2  •"  Ri  Ri+ 1  Ri+ 2  4m  ”■  4n\  (22) 

7?/+l ,  Rj+2  are  the  reactions  in  the  tangential  plane  as  a  result  of  the  existing  stiction.  In  the  modified  matrix  <Pq  -  & Q^st ) 

all  the  elements  of  columns  /,  i+1,  <+2  are  equal  zero.  An  important  task  of  the  contact  analysis  is  that  of  verification  of  the 
conditions  for  stiction.  If  the  tangential  velocity  in  the  point  of  contact  is  equal  zero  there  exists  two  possibilities,  i.  e.:  sliding  or 
stiction. 

The  algorithm  proposed  in  the  article  provides  easily  implemented  numerical  algorithm  for  transformation  of  the  DAE 
without  changing  the  number  of  the  differential  equations  and  parameters  in  case  of  contact.  Especially  convenient  the  approach 

is  if  applied  for  multiple  contact  problem  solution.  The  matrices  M,  <Pq  ,  Q  are  modified  using  simple  and  independent 

substitution  of  the  elements  of  the  columns  that  correspond  to  the  coordinates  describing  the  motions  in  the  points  of  contact.  For 
multiple  contact  points  a  combinatorial  task  of  all  the  possible  contact  events  (sliding  and  stiction)  in  every  contact  point  should 
be  compiled  and  every  combination  should  be  checked  for  fulfilling  of  the  contact  conditions  and  for  the  conditions  for  stiction 
and  sliding. 

5.2.  FRICTIONAL  IMPACT 

In  terms  of  the  mathematics  the  IME  do  not  regard  the  kind  of  the  velocity  jump,  i.e.  compression  or  restitution  -  they  are 
identical  for  these  two  phases.  The  separate  investigation  of  the  two  phases  of  the  impact  process  is  applied  in  several  treatments 
[10,  13].  Here,  according  to  the  positive  direction  of  the  normal  in  the  contact  point  (Fig.  1,  2),  the  normal  velocity  at  the  stage  of 
compression  is  negative.  The  tangential  velocity  could  be  negative  or  positive.  The  normal  impulse  for  both  the  stages  is  positive 
and  the  tangential  impulse  depends  on  the  direction  of  the  tangential  velocity.  The  impact  laws  for  the  compression  and 
restitution  phases  are  identical  and  the  solution  of  the  IME  is  quite  the  same  for  both  stages. 
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5.2.1.  Stiction  with  zero  and  non-zero  approach  tangential  velocity 

Newton’s  hypothesis.  At  the  beginning  of  impact  the  configuration  of  a  multibody  system  and  the  coefficient  of  friction  impose 
conditions  that  prevent  any  kind  of  sliding,  i.c.  instant  stiction  occurs.  With  given  norma!  A qf  =  0-qfj~)  and  tangential 

^<+1  =  0  ~  yU\  >  tyf+2  ~  0  "  </[+  2  jumPs  °r  lllc  velocities  at  the  compression  (superscript  “c")  phase  the  impulses  If  , 

fi+ 1  ’  /«>2  and  thc  o'her  jumps  of  the  gcncralix.cd  velocities  could  be  obtained  solving  the  modified  linear  equation  system  of 

the  IME.  The  superscripts  for  compression  and  restitution  “r  “  will  be  used  if  it  is  needed  for  the  explanations.  Thc  IME  in  case  of 
stiction  for  thc  r  coordinate  arc: 


M.(‘st)  -<PTq  .N(^)]  +  r^  Mi+ 1  Mi+2 1  J’ 

®Q(‘st)  0m  L  h  J  Urn  0m  0m  \  7,+1 


L  JlTij 

Thc  modified  matrices  M(isl)  and  &Q(isl )  coincides  with  thc  same  matrices  in  Section  5.1.  Thc  matrix  of  thc  velocity  jumps 
A Q 's  transformed  to  matrix  of  thc  unknown  parameters  that  includes  thc  impulses  in  thc  point  of  impact,  i.  e.: 

A{?(4/)  =  [A41  Aq2  •••  /,  /(+|  /,-+ 2  A?, +3  ...  Aqn  ]  (25) 

The  free  part  of  the  linear  equation  system  (24)  is  obtained  by  simple  multiplication  of  columns  i,  /+1,  i+2  of  matrix  M  by  thc 
known  jumps  of  the  velocities  in  the  contact  point.  Thc  inertia  and  mass  parameters  of  thc  system  arc  thc  reason  for  tangential 
impulse  /r  , 


lx  -  V/2+i  +  J/+2 


calculated  from  equation  (24)  that  is  thc  maxima!  possible  tangential  impulse  thc  system  could  produce.  Thc  conditions  for 
stiction  are: 

•/,- .  IK  ||=o 

I  I  (27) 

k|-^‘  .  |Ki>o 

Using  the  Newton’s  coefficient  of  restitution  thc  velocity  jumps  A qf  =  e  -A qf ,  A qf+l  =  e  Aqf+l ,  Aqf+2  =  e  ■  Aqf+  2  arc 
calculated  and  thc  same  IME  (24)  is  solved  for  thc  restitution  phase. 

Poisson ’s  hypothesis.  The  hypothesis  of  Poisson  defines  thc  coefficient  of  restitution  by  the  ratio 


between  thc  accumulated  normal  impulses  if  and  If  corresponding,  respectively,  to  thc  phases  of  restitution  and  compression. 
In  thc  same  way  thc  coefficient  of  restitution  for  the  tangential  impulses  could  be  defined  in  case  of  stiction  in  the  tangential 
plane.  Obviously,  both  hypotheses  demand  thc  solution  of  common  modified  IME  (24)  for  thc  compression  phase.  Solving 

equation  (24)  for  the  compression  phase  we  obtain  thc  impulses  if  ,lf+],  lf+2  and  using  the  data  for  thc  Poisson’s  coefficient 
of  restitution  we  obtain  thc  impulses  If  =  C/;  •  if  ,  lf+]  =  c>  •  lf+}  ,  jf+2  =  Cp  .  ff+2  for  thc  rcstitution  phasc  ^  impulscs 
in  thc  point  of  contact  that  should  be  reversed  at  thc  restitution  phase  build  the  free  part  of  the  following  IME 

0i- 1  1 

T  Tl  r  n  I; 


0Q  °n 


M  -0Q  AQ  ' 

„  r  “ 


\yr\+m-i-2  J 

for  the  unknown  velocity  jumps  AQ  and  impulses  of  the  constraints. 

5.2.2.  Sliding 

Newton's  hypothesis.  If  sliding  occurs,  the  tangential  frictional  impulses  cither  at  thc  compression  or  at  thc  restitution  stage 
depend  on  the  normal  impulse  /,  and  the  kinetic  coefficient  of  friction  p.  Thc  directions  of  thc  tangential  impulses  /l+), 
/ i+2  depend  on  thc  relative  tangential  velocity  and  thc  kinetic  coefficient  of  friction,  i.  e.: 


/?/+ 1  +  ill 


*  A'  Mj'+m  '  ?i  >  m  1,2 
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With  know  jump  A qf  of  the  normal  velocity  at  the  compression  phase  the  IME  are  modified  as  follows: 

Mi}  si)  -®Q  [A2(4/)l  ...  (31) 

;  +  '  =  0n+m 

(‘si )  Om  L  ^3.  J  L  °m  . 

The  modified  matrices  M(‘sl)  anf^  ®.q(‘.si)  arc  the  same  as  defined  by  the  equations  (20)  and  in  Section  5.1.  The  modified 
matrix  of  the  parameters 

AC('s/)  =  [A<?i  Ac/2  •••  /,•  AqM  •••  Aqn\  (32) 

is  similar  to  matrix  Q(isi)  of  equation  (21).  The  solution  of  equation  (31)  gives  as  a  result  the  velocity  jumps  of  the  coordinates, 
the  normal  impulse  If  at  the  compression  phase,  and  the  impulses  of  the  constraints. 

Using  the  coefficient  of  restitution  the  jump  of  the  normal  velocity  A qf  at  the  restitution  phase  is  calculated  and  used  as 

•  r 

known  parameter  in  the  same  linear  equation  system  (31)  which  is  to  be  solved  for  A Q  of  the  unknown  velocity  jumps  and 
normal  impulse  //  at  the  restitution  phase. 

Poisson’s  hypothesis.  The  normal  impulse  If  obtained  solving  the  linear  system  (31)  and  the  coefficient  of  restitution  of 

Poisson  are  used  for  calculation  of  the  normal  impulse  if  at  the  time  of  the  restitution  that,  in  its  turn,  as  know  parameter  built 
the  free  part  of  the  IME 


M  -0O  A  Q 


h  =on 


that  should  be  solved  for  the  unknown  velocity  jumps  A  Qr  . 


5.2.3.  Dominant  velocity  jump  in  the  tangential  velocity.  A  phenomenon  we  shall  discuss  here  is  the  case  if  reverse  sliding  with 
non-zero  approach  tangential  velocity.  This  event  could  be  obtained  either  in  the  compression  or  in  the  restitution  phase.  Having 
in  mind  that  we  use  here  common  numerical  algorithm  for  both  the  stages,  the  case  of  dominant  tangential  velocity  jump  will  be 
regarded  for  single  discrete  value  of  the  normal  velocity  jump  or  normal  impulse. 

The  physical  nature  of  the  problem  stated  here  could  be  easily  understood  if  impact  is  regarded  in  two-dimensional  space, 
which  means  that  the  tangential  velocity  has  only  one  component  along  one  tangential  axis.  If  this  velocity  at  the  beginning  of 
impact  is  non  zero,  there  is  no  condition  for  instant  stiction,  and  solving  IME  (31)  for  given  normal  velocity  jump  (Newton’s 
hypothesis)  or  normal  impulse  (Poisson’s  hypothesis)  respectively,  one  could  obtain  resultant  tangential  velocity  with  different 
sign  of  the  initial  one.  This  means  that  the  tangential  velocity  jump  is  greater  than  the  initial  tangential  velocity  and  with  different 
sign,  i.e.  during  the  impact  the  tangential  velocity  becomes  zero  and  changes  it  sign  afterwards. 

In  case  of  spatial  impact,  if  dominant  tangential  jump  should  be  considered,  the  modified  IME  are  as  follows: 


where  Mytjj  *s  the  mass  matrix  modified  according  to  the  known  jump  for  the  tangential  velocity.  Solving  the  IME  (34)  we 

obtain  only  a  part  of  the  whole  normal  velocity  jump  (Newton’s  hypothesis)  or  the  a  part  of  the  whole  normal  Impulse 
(Poisson’s  hypothesis).  The  remaining  part  of  the  normal  velocity  jump  (or  the  normal  impulse)  should  be  realized  checking, 
because  of  zero  tangential  velocity  so  obtained,  for  stiction  and  if  not  then  solving  the  IME  in  case  of  sliding. 

5.3.  NUMERICAL  ALGORITHM  FOR  IMPACT  PROBLEM  SOLUTION 


The  compression  and  restitution  phases  have  its  own  initial  and  final  velocities.  The  initial  velocities  for  the  restitution  phase 
are  the  final  velocities  for  the  compression  phase.  The  solution  of  the  rigid-body  system  impact  problem  will  be  achieved  using 
consequently  one  and  the  same  numerical  algorithm  for  the  two  phases,  compression  and  restitution  of  the  impact  event.  Three- 
step  numerical  procedure  is  developed. 

Step  A.  With  the  initial  normal  and  tangential  velocities  (Newton’s  hypothesis)  or  normal  impulse  (Poisson’s  hypothesis)  the 
modified  IME  are  solved  for  the  case  of  stiction.  If  the  conditions  for  stiction  are: 

-  fulfilled,  then  the  solution  so  obtained  is  the  final  solution; 

-  not  fulfilled,  then  the  next  step  follows. 

Step  B.  With  the  same  initial  tangential  and  normal  velocities  or  normal  impulse,  the  modified  IME  arc  solved  in  case  of 
sliding.  If  the  condition  for  dominant  tangential  jump  is: 

-  not  fulfilled,  then  the  solution  so  obtained  is  the  final  solution ; 
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with  the  ncxf’stcp"  ^  “*  S°'VCd  in  CaSC  of  dominant  tan«cntial  velocity  jump  and  the  impact  analysis  continues 

“  ri“rc  or  impu,sc  *° be  ^  -d  *“  * 

By  the  algorithm  presented  here  all  possible  impact  events  arc  numerically  simulated  i  e  • 

(a)  compression  phase  ’  '  " 

-  instant  stiction  with  no  relative  approach  tangential  velocity; 

-  instant  stiction  with  relative  approach  tangential  velocity; 

-  sliding  with  no  relative  approach  tangential  velocity; 

-sliding; 

-  sliding  and  reverse  sliding; 

-  sliding  and  stiction; 

(b)  restitution  phase 

-  continuos  stiction; 

-continuous  sliding; 

-  continuous  sliding  and  reverse  sliding; 

-  continuous  sliding  and  stiction. 

Simulation  of  the  dynamics  of  multibody  system  in  case  of  multiple  impact  point  is  similar  of  the  case  of  multiple  contact 
points.  The  transformation  of  the  matrices  M(isl) ,  *£</„),  M.(hj)  is  independent  for  every  coordinate  in  which  impact 
event  occurs.  Every  coordinate  causes  transformations  of  the  corresponding  column  of  matrix  M. 

6.  Frictional  Contact  orFlexible  Multibody  Systems 

ismssifii 

respectively^  nT' toaTSdbodWFinl  StT  poifnt  ,and  i,s  *angcntial  plane  and  normal  is  the  contact  of  flexible  body, 

wmmm 


element  / 


element/ 


node  2\:'-'P 


element  / 


element  i 


element  j  n 


y.  ^  element  / 
(0 


ZJ  ' 


Fig.  3.  Flexible  elements  and  definition  of  contact  point  tangential  planes 
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the  contact  problems  and  using  the  possible  penetration  for  estimation  of  contact  forces  will  conclude  that  there  is  many  common 
definitions  of  the  normal  penetration  and  the  normal  in  the  tangential  plane.  Of  course,  there  are  many  difficulties  and  one  of  it  is 
if  the  contact  point  goes  from  one  element  to  another. 

In  the  finite  element  theory  the  deflections  of  the  nodes  are  with  respect  to  the  inertial  reference  frames.  Absolute  coordinates 
are  very  appropriate  if  a  flexible  body  comes  into  contact  with  a  body  that  coincides  with  the  inertial  reference  frame.  But  if 
contact  occurs  between  two  moving  bodies,  the  contact  should  be  described  in  terms  of  relative  coordinates.  The  author  of  this 
treatment  suggested  in  [21]  an  approach  of  relative  coordinates  for  modeling  of  rigid  and  flexible  multibody  system  dynamics. 
This  method  defines  at  every  time  step  the  position  of  the  body  or  element  coordinate  system,  respectively  the  contact  tangential 
plane  and  its  normal.  So,  the  contact  of  flexible  systems  could  be  described  as  a  contact  of  a  node  of  a  flexible  body  with  an 
element  of  another  body.  Respectively,  the  possible  motions  of  this  node  are  with  respect  to  the  coordinate  system  of  the  clement 
of  the  other  body  (Fig.  4)  and  these  motions  are  included  in  matrix  -  vector  Q  of  the  coordinates.  It  could  be  easily  verified  that 
this  presentation  allows  the  algorithm  suggested  here  to  be  directly  applied  for  simulation  of  contact  of  flexible  bodies.  In  case  of 
contact  of  flexible  beam  elements  (Fig.  5)  the  coordinates  that  describe  the  possible  motions  in  the  contact  point  are  the 
translations  along  the  beam  axes  and  the  common  normal. 


Fig.  4:  Incoming  contact  of  a  node  with  an 
element  of  flexible  bodies 


Fig.  5:  Incoming  contact  of  two  beams 


6.  Examples 

In  Figure  6  an  example  of  double  pendulum  rigid  body  system  is  presented.  This  example  is  well  studied  in  the  scientific 
literature  [13]  and  it  is  presented  here  to  verify  the  results  obtained  by  the  method  suggested.  In  Figures  7  and  8  two  examples  of 
impacts  of  slender  beam  and  thin  wall  ring  with  the  ground  are  presented. 


Fig.  6:  Impact  of  rigid  body  double  pendulum  Fig.  7:  Impact  and  large  flexible  deflections  of  slender  beam 


Fig.  8:  Impact  and  multiple  node  contact  of  thin  flexible  ring 
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